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ABSTRACT 


The  concept  of  controlling  optical  laser  beams  on  spacecraft  for  acquisition, 
tracking  and  pointing  purposes  is  quickly  becoming  a  reality.  As  a  result,  fine  pointing  of 
laser  beams  is  turn  out  to  be  an  increasingly  important  research  topic.  A  unique  testbed 
was  constructed  in  order  to  study  and  develop  new  methods  for  laser  beam  control.  This 
testbed,  the  Moving  Target-Source  Test  Fixture  (MTSTF),  hosts  a  laser  source,  the 
Extremely  Agile  Relaying  Laser  Source  (EARLS),  which  has  the  capability  of 
automatically  acquiring  and  directing  a  laser  beam  onto  a  satellite  simulator  while  in 
motion.  The  purpose  of  this  thesis  is  to  make  the  EARLS  platform  operational  by 
developing  a  tracking  control  system.  The  ultimate  goal  is  to  point  the  laser  beam  at  the 
satellite  simulator’s  receiving  telescope  and  maintain  the  laser  within  the  telescope’s 
limits  in  the  presence  of  structural  disturbance  induced  by  the  EARLS  motion. 
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I. 


INTRODUCTION 


A.  BACKGROUND 

1.  Motivation 

The  recent  advancements  in  laser  technology  have  made  possible  the  concept  of 
using  lasers  on  spacecraft  for  targeting  ground-based  objects.  Lasers  on  spacecraft  can  be 
used  for  communications,  target  acquisition  as  well  as  imaging.  While  this  concept  is  a 
possibility  it  does  present  several  challenging  engineering  problems  that  must  be 
overcome  prior  to  full  scale  testing.  In  particular,  the  greatest  challenge  is  fine  pointing 
of  a  laser  beam  in  the  presence  of  structural  vibrations. 

All  spacecraft  has  machinery  that  rotates  and  hence  produce  vibrations  throughout 
the  structure.  While  this  vibration  may  be  small  it  has  an  exaggerated  effect  on  laser 
beam  pointing.  The  undesired  movement  in  the  laser  beam  is  termed  “jitter.”  As 
Watkins  states  in  his  PhD  dissertation[Watkins,  2004],  “A  100mm  diameter  laser  beam 
with  10  prad  of  jitter  will  result  in  roughly  a  400  fold  decrease  in  the  intensity  of  the 
beam  at  100  km,  due  to  jitter  alone.”  Jitter  can  also  be  induced  by  maneuvering  the 
spacecraft  with  thrusters  and  exciting  natural  frequencies.  This  is  particularly 
problematic  since  a  typical  spacecraft  has  very  little  structural  damping  so  vibrations  can 
take  several  minutes  to  diminish. 

In  order  to  study  these  problems  and  produce  solutions  the  Naval  Postgraduate 
School  created  the  Bifocal  Relay  Mirror  Laboratory  (BFRM).  This  laboratory  has 
testbeds  that  simulate  the  spacecraft  and  laser  system  in  space  like  conditions.  This  thesis 
focuses  on  the  development  of  a  tracking  control  system  for  a  laser  source  system  in  the 
BFRM  Laboratory  while  reducing  being  subject  to  structural  disturbances. 


2.  Historical  Context 

The  BFRM  Spacecraft  Project  has  its  roots  in  Strategic  Defense  Initiative  (SDI) 
experiments  during  the  late  1980’s  and  early  1990’s.  Specifically,  the  Relay  Mirror 
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Experiment  (RME)  which  successfully  targeted  a  ground  based  laser  on  an  orbiting 
satellite  then  reflected  the  laser  radiation  to  another  ground  facility. 


The  motivation  behind  this  experiment  was  its  potential  application  to  ballistic 
missile  defense.  Shortly  afterwards  public  policy  changed  and  the  motivation  to  continue 
with  the  experiment  was  lost.  However,  the  United  States  Air  Force  continued  working 
on  some  of  the  technical  challenges  posed  by  the  Relay  Mirror  Experiment  for  its 
airborne  laser  system  such  as  laser  beam  forming,  beam  tracking  and  pointing  and  jitter 
control.  In  the  late  1990’s  a  study  performed  by  the  Air  Force  Research  Laboratory 
recognized  potential  missions  for  a  space  based  optical  relay  mirror.  Among  these 
missions  are  camouflage  detection  and  penetration,  chemical  warfare  agent  detection  and 
identification,  illumination  for  nighttime  operation  and  active  imaging,  and  a  laser  fence 
for  aircraft  detection  and  underground  structure  detection. 
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3.  Bifocal  Relay  Mirror  Laboratory 

In  2000,  a  preliminary  satellite  design  was  eompleted  by  a  team  of  Naval 
Postgraduate  Sehool  masters  students  resulting  in  a  seissor-like  Bifoeal  Relay  Mirror 
spaeecraft.  The  spaceeraft  eonsists  of  two  optieally  coupled  telescopes  including 
adaptive  optics  used  to  redirect  the  light  from  a  ground  based  laser  to  a  distant  target  as 
seen  in  Figure  2. 


Bifocal  Relay  Mirror  Spacecraft 


Transmit  Tata  scops 


Figure  2.  Bifocal  Relay  Mirror  Spacecraft 

A  receiver  telescope  collects  the  incoming  laser  energy  and  channels  it  through 
internal  relay  optics  to  a  transmitter  telescope.  The  transmitter  telescope  directs  the 
energy  against  the  desired  target  as  seen  in  Figure  3. 
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Figure  3.  Bifocal  Relay  Mirror  Operational  Concept 


The  design  specified  a  target  acquisition  and  tracking  systems  for  each  telescope  with  the 
transmitter  side  requiring  the  added  capability  of  tracking  uncooperative  terrestrial  based 
targets.  The  former  masters  students  identified  several  unique  technologies  on 
acquisition,  tracking  and  pointing  of  laser  beam  optics  that  need  to  be  developed  prior  to 
operation  of  this  spacecraft. 

In  December  2000,  the  NFS  Spacecraft  Research  and  Design  Center  (SRDC)  and 
AFRL  submitted  a  proposal  to  National  Reconnaissance  Office  for  funding  to  develop 
these  unique  technologies  for  spacecraft  purposes.  The  proposal  was  awarded  in  January 
2001  and  the  Bifocal  Relay  Mirror  Laboratory  was  created  at  the  Naval  Postgraduate 
School.  The  ultimate  goal  of  the  Bifocal  Relay  Mirror  Laboratory  is  to  develop 
acquisition  tracking  and  pointing  of  the  Bifocal  Relay  Mirror  Spacecraft. 
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B.  Thesis  Overview 

Chapter  II  introduces  the  equipment  used  for  experimental  purposes  to  include  the 
Three  Axis  Satellite  Simulator  testbed,  Moving  Target  Source  Test  Fixture  and 
Extremely  Agile  Relaying  Source  Laser.  The  sensors  and  actuators,  as  well  as  the 
computer  control  system  will  be  explained  in  detail. 

Chapter  III  details  the  system  identification  process  of  the  Extremely  Agile 
Relaying  Source  Laser  components.  Experimental  data  will  be  compiled  and 
mathematically  manipulated  to  form  transfer  functions  for  the  system  components.  The 
mathematical  models  will  be  verified  by  comparing  the  model  to  the  experimental  test 
results. 

Chapter  IV  explains  the  control  methods  used  to  make  various  Extremely  Agile 
Relaying  Source  Laser  testbed  components  operational.  A  review  of  the  associated 
control  theory  will  be  presented  as  well  as  a  detail  explanation  of  implementation. 

The  experimental  results  and  analysis  will  be  presented  in  Chapter  V  and  the 
conclusions  and  recommendations  will  discussed  in  Chapter  VI. 
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II.  EXPERIMENTAL  SETUP 


A.  THREE  AXIS  SATELLITE  SIMULATOR  TESTBED  (TASS) 

The  Bifocal  Relay  Mirror  Laboratory  hosts  the  second  generation  satellite 
simulator  (TASS2).  TASS2  is  a  test  platform  used  to  simulate  the  Bifocal  Relay  Mirror 
Spacecraft.  TASS2  consists  of  a  satellite  bus  and  optical  payload  as  seen  in  Figure  4. 


Receiver  TelescopB 
T  ra  nsm  itte  r  Te  lesco  p  e 


Optical 

Payload 


Satellite 

Bus 


Figure  4.  Three  Axis  Satellite  Simulator  #2  (TASS2) 


TASS2  rests  on  a  spherical  air  bearing  which  when  pressurized,  allows  the  testbed 
to  float  in  a  near  frictionless  environment  simulating  extraterrestrial  conditions.  The 
satellite  bus  attitude  control  is  maintained  by  four  single  gimbal  Control  Moment 
Gyroscopes  (CMGs).  The  CMGs  are  attached  to  a  hinged  frame  which  allows  them  to  be 
reconfigured  to  different  skew  angles.  The  satellite  bus  is  balanced  by  an  automatic  mass 
balancing  system.  Several  proof  masses  are  placed  around  the  bus  on  linear  drives 
allowing  both  horizontal  and  vertical  motion  of  control  TASS2’s  center  of  gravity. 
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TASS2’s  optical  payload  is  positioned  on  a  separate  deck  on  top  of  the  satellite 
bus.  The  optical  payload,  as  seen  in  the  Figure  5,  consists  of  receiving  and  transmitting 
telescopes,  two  Baker  Adaptive  Optics  fast  steering  mirrors  for  jitter  control  and  fine 
laser  steering,  a  Position  Sensing  Detector  (PSD)  that  obtains  the  reference  signal, 
cameras  for  acquiring  the  source  platform  and  a  Newport  optical  train  components  for 
laser  beam  routing  and  alignment. 


TARGET  WIDE 
FIELO-OF-VIEW 
CCO  CAMERA 


632NM  LASER  BEACON 
UGHTFROM  TARGET 


OUTGOING  LASER  BEAM 
FROM  TO  TARGET 


TAS2  OPTICAL  PAYLOAD  DETAILS 


PERISCOPE  TO 
LOWER  DECK 


JITTER 

STABILIZING 

FAST 

STEERING 

MIRROR 


JITTER  POSITION 
SENSING 
DETECTOR  (PSD) 


472NM  SOURCE 
WIDE  FIELD-OF-VIEW 
CCO  CAMERA 


RECEIVER 
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TARGET 

TRACKING 

FAST 

STEERING 

MIRROR 


633NM  TARGET  MAIN 
LASER  NARROW  FIELD-OF 
VIEW  FAST  CMO  S  CAMERA 


INCOMING  LASER  BEAM 
FROM  EARL  SOURCE 


532NM  TARGET 
DESIGNATOR  NARROW 
FIB-O^F-VIEW  FAST 
CMOS  CAMERA 


INCOMING  BLUE  3-LED  BEACON 
UGHTFROM  EARL  SOURCE 


Figure  5.  TASS2  Optical  Payload 


The  purpose  of  the  optical  payload  is  to  receive  incoming  laser  energy  from  the 
laser  source  then  redirect  the  laser  energy  to  a  target.  The  optical  payload  is  also  capable 
of  steering  the  laser  source  on  a  moving  target  as  well  as  negates  the  effect  of  jitter  using 
a  fast  steering  mirror  (FSM).  The  payload  deck  is  motorized  and  can  be  rotated  about  the 
satellite’s  Y  body  axis  or  axis  that  runs  thru  the  center  of  rotation  to  the  air  bearing.  A 
more  thorough  explanation  of  TASS2’s  hardware  can  be  found  in  [Kulick,  2004]. 


8 


B.  MOVING  TARGET-SOURCE  TEST  FIXTURE  (MTSTF). 

The  laboratory  also  hosts  a  testbed  that  simulates  the  laser  source  and  target.  This 
testbed  is  known  as  the  Moving  Target-Source  Test  Fixture  (MTSTF)  and  can  be  seen  in 
Figure  6. 


Figure  6.  Moving  Target-Source  Test  Fixture  (MTSTF) 


It  was  designed  and  built  by  Guidance  Dynamics  Corporation  and  delivered  to  the  BFRM 
laboratory  in  June  2005.  The  MTSTF  testbed  independently  operates  the  source  and 
target  platforms  on  linear  stages  or  tracks.  The  source  platform  was  given  the  name 
Extremely  Agile  Relaying  Laser  Source  (EARLS)  and  the  target  is  called  Diagnostic 
Target  (DT). 

The  idea  of  MTSTF  is  to  provide  a  laser  source  (EARLS)  to  aim  at  the  satellite 
(TASS2)  while  also  providing  a  target  (DT)  for  the  satellite  to  acquire  and  track  as  seen 
in  Figure  7. 
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EXPERIMENTAL  LAYOUT 


Figure  7.  Experimental  Layout 


Since  it  would  be  exceptionally  difficult  to  simulate  orbiting  motion  in  the 
laboratory  by  rotating  TASS2  around  a  laser  source,  the  decision  was  made  to  move  the 
laser  source  with  respect  to  TASS2.  So  the  laser  source  assembly  was  placed  on  a  linear 
motion  track  permitting  it  to  be  moved  at  a  velocity  comparable  with  an  orbital  rate.  The 
target  was  also  placed  on  a  separate  linear  track  so  it  may  behave  in  an  uncooperative 
manner.  The  MTSTF  drive  components,  source  components  and  target  components  will 
be  explained  in  more  detail  below 

1.  Moving  Target-Source  Test  Fixture  Drive  Components 
a.  Linear  Track 

The  track  consists  of  two  independently  operated  linear  tracks  as  seen  in 

Figure  8. 
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Figure  8.  MTSF  Highlighting  Independently  Operated  Linear 
Actuators 

Both  linear  tracks  are  belt  driven  and  manufactured  by  Parker  Hannifin,  Model  HPLA 
120/406XR,  Model#  802-7633D.  The  track  has  limit  switches  at  each  end  that  results  in 
a  software  shutdown  when  tripped.  Technical  specifications  are  provided  in  Appendix  A 
and  can  be  found  at: 

httr>://www.r>arkermotion.com/r)roducts/Belt  Driven  Linear  Actuators  5485  30  32  80  567 

29.html 


Source  f  EARLS 


Target  (D 


Target  Linear  Track  1 

MlliiH  \ 


Source  Linear  Track 
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b.  Prime  Movers 

The  prime  mover  for  each  linear  actuator  is  a  Parker  Hannifin  J  series 
brushless  servo  motor,  Model#  J0922JE-KPSN.  The  motors  are  driven  by  a  Gemini  GV 
Series  digital  servo  drive,  Model#  RS-232/485.  Technical  Details  for  the  motors  are 
provided  in  Appendix  B  and  can  be  found  at: 

http://www.parkermotion.com/products/Rotarv  Servo  Motors  5208  30  32  80  567  29.html 

c.  Controller 

The  motion  for  the  linear  actuator  is  controlled  by  a  Parker  6K  series  six 
axis  controller.  The  controller  can  be  programmed  via  an  attached  personal  computer 
which  has  the  Parker  Motion  Planner  software.  Technical  specifications  for  the  6K 
controller  are  provided  in  Appendix  C  and  can  be  found  at: 
http://www.parkermotion.com/products/Controllers  1745  30  32  80  567  29.html 

2.  Extremely  Agile  Relaying  Laser  Source  (EARLS) 

The  principal  components  of  the  EARLS  assembly  are  the  two  motors  and  optical 
board  for  the  laser  assembly.  One  motor  is  for  azimuth  rotation  and  the  other  is  for 
elevation  rotation.  The  laser  assembly  is  mounted  on  a  vertical  breadboard  which  is 
attached  to  the  elevation  motor.  The  laser  assembly  is  composed  of  the  following  major 
components  which  can  be  seen  in  Figure  9: 

1.  A  New  Focus  model  #9935  optical  laser  source 

2.  A  Baker  Adaptive  Optics  FSM  for  jitter  control 

3.  An  Orion  102mm  optical  telescope 

4.  A  Watec  video  camera  for  acquiring  TASS2 

5.  And  a  Newport  optical  train  for  laser  beam  routing  and  alignment.. 
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Figure  9.  Extremely  Agile  Relaying  Laser  Source  (EARLS) 


The  laser  beam  originates  at  the  source  and  passes  through  an  optical  train  to  the 
FSM.  The  laser  beam  then  reflects  off  the  FSM  and  passes  through  a  beam  expanding 
telescope  which  forms  the  beam  into  a  102mm  diameter  doughnut  shape.  Upon  departure 
from  the  telescope,  the  laser  beam  travels  to  the  optical  payload  on  TASS2. 
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a.  Fast  Steering  Mirror  (FSM) 

The  FSM  was  designed  and  built  by  Baker  Adaptive  Opties  as  can  be  seen 

in  Figure  10. 


Figure  10.  Fast  Steering  Mirror  (FSM) 


The  intent  of  the  source  FSM  is  to  eliminate  disturbances  and  vibrations  induced  by  the 
sources  motion  along  the  linear  track  as  well  as  fine  steering  of  the  laser  beam.  The  FSM 
has  a  one  inch  diameter  mirror  and  uses  voice  coils  to  position  the  mirror  in  response  to 
input  commands.  The  voice  coils  are  placed  orthogonally  to  drive  the  mirror  in  the  X  & 
Y  “tip-tilt”  directions.  The  FSM  is  driven  and  controlled  by  an  embedded  MATLAB 
software  program.  The  control  bandwidth  for  the  FSM  is  less  than  350  Hz,  depending  on 
the  direction  of  motion,  and  the  maximum  applied  voltage  in  either  direction  is  5  volts. 
Additionally,  the  natural  frequency  is  approximately  230  Hz  depending  on  the  direction 
of  motion. 
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b.  Video  Camera 

The  video  camera  is  a  Watec  Model  WAT-902.  The  camera  has  a  pixel 
field  of  view  of  81 1(H)  x  508(V)  however  a  field  of  view  of  640(H)  x  480(V)  is  utilized 
in  the  experiments.  The  complete  camera  specifications  can  be  seen  in  Appendix  D. 
Mounted  on  the  camera  is  a  Nikon  AT  Nikkor  50mm  1:1.8  zoom  lens  to  obtain  a  desired 
field  of  view. 

The  camera  is  captures  a  black  and  white  image  with  a  MATLAB  embedded 
function.  It  operates  at  an  update  rate  of  approximately  30  Hz  which  incidentally  makes 
this  device  the  limiting  hardware  in  the  control  loop.  The  camera  captures  images  of  a 
three  point  LED  assembly  located  on  TASS2  for  position  feedback  as  seen  in 
Figure  11. 


Figure  11.  Location  of  LED  Beacons  on  TASS2 
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c.  Laser  Assembly  Platform 

The  laser  source  assembly  is  mounted  on  a  two  degree  of  freedom 
motorized  platform  allowing  the  laser  to  rotate  in  both  the  azimuth  and  elevation 
directions.  The  motors  are  Newport  RV120-MVTP  high  performance  precision  rotation 
stages.  Theses  120mm  diameter  motors  have  the  capability  to  travel  360°  continuous, 
however,  hardware  limit  switches  are  installed  on  the  platform  to  prevent  excess  rotation. 
The  motors  have  an  encoder  feedback  resolution  of  0.001°.  A  CyberResearch  mini-PC  is 
mounted  on  the  back  of  the  platform  for  processing  and  motor/FSM  control. 
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III.  SYSTEM  IDENTIFICATION 


A.  OVERVIEW 

Analytically  deriving  a  mathematical  model  of  the  laser  source  and  track  would 
have  been  unreasonably  difficult  undertaking  due  to  the  complexity  of  the  system.  Many 
of  the  physical  characteristics  of  the  system  are  unknown  such  as  mass,  moment  of 
inertia,  coulomb  and  viscous  friction  and  center  of  mass.  Therefore,  in  this  report  a 
simple  linear  system  is  considered  sufficient  in  determining  the  transfer  functions  of  the 
motors  and  FSM.  Each  of  these  transfer  functions  was  determined  through  experimental 
analysis. 


B.  TRANSFER  FUNCTION  OF  AZIMUTH  AND  ELEVATION  MOTORS 
1.  Mathematical  Approach  to  Determining  the  Transfer  Function 

[Chen,  1993]  was  used  as  a  guide  in  the  following  derivation  of  equations.  The 
DC  electric  motors  were  modeled  as  seen  in  the  Figure  12. 
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Figure  12.  Electrical  Schematic  of  a  DC  Motor 


The  torque  generated  by  the  motor  is  given  by 


Equation  (2.1) 
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where  kt  is  a  torque  constant.  Due  to  the  external  load  an  electromotive  force  (back  emf) 
will  develop  in  the  circuit  to  resist  the  applied  voltage  (Vin).  The  back  emf  voltage,  Vb, 
is  linearly  proportional  to  the  angular  velocity  of  the  motor  shaft  and  can  be  represented 
as 


Fj  (t)  =  Equation  (2.2) 

dt 


Where  kb  is  a  constant.  The  motor  circuit  can  be  represented  by  the  following 
equation  of  motion. 


Ri{t)  +  L^^  +  V^{t)  =  VJt)  Equation  (2.3) 

dt 


Substituting  Equation  (2.2)  into  Equation  (2.3)  yields 


Ri{t)  +  L  =  V.^  it)  Equation  (2.4) 

dt  dt 


Now  consider  the  external  load  which  rotates  about  the  motor  shaft.  The 
dynamics  can  be  represented  as 


d  6  dO 

J  ——  +  f—  =  T^  Equation  (2.5) 

dt  dt 
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Where  J  is  the  total  moment  of  inertia  of  the  shaft;  0,  the  angular  displacement; 
and  /is  the  viscous  friction  coefficient  of  the  bearing.  Substituting  Equation  (2.1)  into 
(2.5)  and  taking  the  Laplace  Transform  yields 

Js^6{s)  +  f  6{s)  =  k/(s)  Equation  (2.6) 

Taking  the  Laplace  Transform  of  equation  (2.4)  and  solving  for  i(s)  yields 

i(s)  =  — — Equation  (2.7) 

Ls  +  R 

Substituting  Equation  (2.7)  into  Equation  (2.6)  yields  the  transfer  function 

G(s)  =  = - — -  Equation  (2.8) 

K  ^[(/^  +  f)(R  +  Ls)  +  ] 

Since  the  electrical  time  constant,  t=  —  ,  is  much  smaller  than  the  mechanical 

R 

time  constant  its  effect  can  be  neglected.  Therefore,  L=0  and  Equation  (2.8)  will  become 

G{s)  =  = - — -  Equation  (2.9) 

s{JRs  +  k,k,+fR) 

Combining  terms  and  converting  to  bode  form  produces  the  first  order  system 
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G(^)  = 


Kh+M 


s(  ^  +  1)  ■'(V  +  l) 

*A+,/K 


Equation  (2.10) 


k  JR 

Where  k  = - *- -  is  the  motor  gain  and  r  = - is  the  motor  time 

KK+M  KK+M 

constant. 

The  block  diagram  of  the  motors  can  be  represented  by  the  following  first  order 

model. 


Input  Voltage  Vm 

k 

Angular  Velocity  u 

w 

Figure  13.  General  Motor  Model 

The  transfer  function  from  input  voltage  to  output  angular  velocity  is 


cois)  =  ^  Equation  (2.1 1) 


Taking  the  inverse  Laplace  transform  yields 

-t 

0){t)  =  -  kVf^e^”  Equation  (2.12) 

As  t  approaches  infinity  Equation  (2.12)  becomes 

<y(oo)  =  kV.^  Equation  (2.13) 
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The  motor  gain  constant  can  be  determined  by  applying  a  voltage  (Vin)  to  the 

V. 

motor,  measuring  0(00)  and  using  Equation  (2.13)  in  the  form  k  =  — Solving  for 

co(co) 

the  motor  time  constant,  Xm,  in  Equation  (2.12)  produces 


= - ^77^  Equation  (2.14) 

ln(l--^) 

co(co) 


This  allows  the  motor  time  constant  to  be  calculated  by  measuring  the  angular  velocity  at 
any  transient  time,  to,  and  steady  state  angular  velocity  co(oo). 


2.  Determination  of  Motor  Transfer  Functions 

In  order  to  establish  the  motor  transfer  functions  a  MATLAB  program  was 
written  to  provide  a  step  input  to  the  motors  and  read  the  encoder  values.  The  encoder 
readings  were  numerically  differentiated  to  obtain  the  motor  velocity,  co,  in  rads/sec.  The 
motor  velocities  were  plotted  as  a  function  of  time  and  co(to)  and  0(00)  were  visually 
extracted.  Using  Q)(to)  and  co(oo)  and  the  input  voltage  (Vin)  in  the  above  equations  ,  the 
transfer  functions  were  computed.  The  computed  transfer  functions  are  presented  in 
Table  1.  Computational  values  used  in  the  calculations  can  be  found  in  Appendix  E. 


Elevation 

Elevation 

Azimuth 

Azimuth 

Up 

Down 

Back 

Forward 

0.0132 

0.014 

0.0158 

0.0152 

0.035  +  1 

0.035  +  1 

0.035  +  1 

0.035  +  1 

Table  1.  Motor  Transfer  Functions 
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Figures  14-17  show  the  actual  system  response  and  transfer  function  response  to  a 
step  voltage  command.  The  “noise”  present  in  the  measured  data  can  be  attributed  to 
effects  of  numerical  integration.  From  these  plots  the  conclusion  can  be  drawn  that  the 
calculated  transfer  functions  accurately  represent  the  motors  for  modeling  purposes.  The 
MATLAB  Program  used  for  determining  the  transfer  function  can  be  seen  in  Appendix  F. 


Figure  14.  Elevation  Motor  Velocity  Measurements  -  Up 
Direction 
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Angular  Velocity  (rad s^sec)  Angular  Velocity  (rad sisec) 


Figure  15.  Elevation  Motor  Velocity  Measurements  -  Down 
Direction 


Figure  16.  Azimuth  Motor  Velocity  Measurements  -  Back 
Direction 
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Angular  Velocity  (rads/sec) 


Figure  17.  Azimuth  Motor  Velocity  Measurements  -  Forward 
Direction 
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C.  TRANSFER  FUNCTION  OF  FAST  STEERING  MIRROR 

In  order  to  determine  the  transfer  function  of  the  FSM,  it  had  to  be  physically 
removed  from  the  laser  source  and  placed  on  the  Laser  Jitter  Control  Testbed  (LJC)  for 
experimental  testing.  A  Position  Sensing  Detector  (PSD)  and  laser  source  were  also 
needed  for  this  experiment.  The  components  were  placed  in  the  configuration  seen  in 
Figure  8. 


Figure  18.  Fast  Steering  Mirror  Experimental  Testing  Set  Up 

While  on  the  LJC,  the  FSM  was  driven  by  the  EARLS  computer  via  a  ribbon 
cable  extension.  A  MATLAB  program  was  written  to  command  the  FSM  with  a  chirp 
signal  frequency  sweep  from  0-800  Hz  (see  code  in  Appendix  G).  The  PSD  was  used  to 
capture  the  laser’s  position  in  millimeters  at  a  sampling  time  of  0.0005  seconds.  So  the 
FSM  voltage  is  the  input  and  the  PSD  data  in  millimeters  is  the  output.  dSPACE 
software  was  used  to  record  and  view  the  raw  data  from  the  PSD.  The  data  was  then 
converted  to  a  MATLAB  compatible  file  and  the  Bode  plot  was  created.  Using  the 
methods  outlined  in  [Ogata,  2002,  Chapter  8]  the  transfer  function  was  extracted  from  the 
Bode  plot. 
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1.  Transfer  Function  for  X  Tip-Tilt  Direction 

Using  the  experimental  data  the  frequency  response  of  the  FSM  for  the  X- 
direction  was  produced  and  can  be  seen  in  Figure  19. 


Frequency  (Hz) 

Figure  19.  Frequency  Response  of  Fast  Steering  Mirror  in  X- 
Direction 


The  FSM  has  a  natural  frequency  at  212  Hz.  From  this  data  the  open  loop 
transfer  function  was  determined  to  be: 


G(s) 


x-dir 


Output{mm)  _  0.63 

Input{volts)  5.636e~^s^  +  \6.52e~^s  + 1 


The  damping  was  found  to  be  0. 1 1 . 
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The  Bode  plot  in  Figure  20  compares  the  actual  FSM  response  to  the  transfer 
function  confirm  that  the  transfer  function  closely  represents  the  mirror  behavior  in  the 
X-direction. 


Frequency  (rads/s) 

Figure  20.  Bode  Plot  of  Experimental  Data  for  X  Direction 
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The  Bode  plot  of  the  transfer  funetion  as  seen  in  Figure  21  shows  a  bandwidth  of  less 
than  326  Hz  and  a  phase  margin  of  26°. 


Bode  Diagram 
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Figure  21.  Bode  Plot  of  Transfer  Function  for  X  direction. 
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2.  Transfer  Function  for  Y  Tip-Tilt  Direction 

Using  the  experimental  data  the  frequency  response  of  the  FSM  for  the  Y- 
direction  was  produced  as  seen  in  Figure  22. 
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Figure  22.  Frequency  Response  of  Fast  Steering  Mirror  in  Y- 
Direction 


The  FSM  has  a  natural  frequency  at  253  Hz.  From  this  data  the  open  loop 
transfer  function  was  determined  to  be: 

_  Output(mm)  _  0.68 

~  Input{volts)  ~  3.895e-V+13.73e-^.s  +  l 

The  damping  was  found  to  be  0. 1 1 . 

The  Bode  plot  in  Figure  23  compares  the  FSM  response  to  the  transfer  function 
confirming  that  the  transfer  function  closely  represents  the  mirror  behavior  in  the  Y- 
direction. 
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Figure  23.  Bode  Plot  of  Experimental  Data  for  Y  Direction 
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The  bandwidth  is  less  than  393  Hz  and  a  phase  margin  of  24°  as  seen  in  the  Bode  plot  of 
Figure  24. 


10^  10^  10“ 

Frequency  (rad/sec) 

Figure  24.  Bode  Plot  of  Transfer  Function  for  Y  direction. 
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IV.  CONTROL  METHODS 


A.  OVERVIEW 

In  order  to  track  TASS2  with  the  EARLS  two  separate  control  laws  had  to  be 
utilized:  one  for  the  FSM  and  one  for  the  motors.  Both  the  motors  and  FSM  are 
independently  operated  and  therefore  separately  driven.  The  elevation  and  azimuth 
motors  are  used  to  keep  the  laser  source  near  the  receiving  telescope  on  TASS2  but 
maybe  not  exactly  on  target.  The  FSM  is  used  for  disturbance  rejection  and  fine  steering 
the  laser  beam  into  the  receiving  telescope  with  little  or  no  error.  Classical  control 
methods  were  used  for  the  motor  operation  while  input  shaping  control  was  used  for  the 
FSM.  An  explanation  of  both  these  methods  will  follow  below. 


B.  FAST  STEERING  MIRROR  CONTROL 

1.  Input  Shaping  Theory 

Since  the  FSM  is  solely  used  for  fine  pointing  of  the  laser  beam  there  is  an 
implied  expectation  that  mirror  has  no  residual  vibrations  after  a  movement.  To  ensure 
this  requirement  is  met  the  “input  shaping”  control  technique  was  chosen  for  this  system. 
A  description  of  this  technique  will  be  detailed  below  using  the  [Singh,  Singhouse]  input 
shaping  tutorial  as  a  guide. 

G.H.  Smith  first  proposed  the  input  shaping  technique  in  which  a  lightly-damped 
system,  subject  to  a  step  input,  could  generate  a  non-oscillatory  response  [Smith,  1956]. 
This  is  achieved  by  exciting  two  transient  oscillations  so  as  to  result  in  beneficial 
cancellation  of  the  oscillations.  For  example,  if  we  give  a  second  order  system  such  as 
the  FSM  an  impulse  input,  vibrations  will  ensue.  Now  if  we  give  the  system  a  second 
impulse  at  a  specified  time  later,  At,  the  vibration  induced  by  the  first  impulse  can  be 
cancelled.  This  is  illustrated  in  Figure  25. 
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Posttioi) 


Figure  25.  Two  Impulse  Response  [From  Sing,  Singhouse] 

In  order  for  this  technique  to  work  effectively  the  amplitudes  of  the 
impulses  and  time  locations  must  be  calculated.  Assuming  that  we  have  an 
accurate  estimate  of  the  FSM’s  natural  frequency  in  rads/sec,  co,  and  damping 
ratio,  then  the  vibration  that  occurs  from  the  impulses  can  be  described  by: 

F(co,  C)  =  Equation  (4.1) 

where, 

C(®,4-)  =  cos(ai,<,) 

/=! 

i=l 
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Ai  and  U  are  the  amplitudes  and  time  locations  of  the  impulses,  n  is  the  number  of 

impulses  and  co^  =  .  Equation  4. 1  physically  represents  the  amount  of  vibration 

that  will  result  from  a  unity-magnitude  impulse.  So  by  setting  this  equation  to  zero  the 
proper  amplitudes  and  time  location  can  be  solved  for.  However,  to  avoid  the  trivial 
solution  of  all  zeroed  valued  impulses  and  to  obtain  the  normalized  result,  we  require  the 
impulses  to  sum  to  one: 

^A.  =\  Equation  (4.2) 

We  also  want  to  require  the  amplitudes  to  by  positive  so: 

Ai  >0,  i  =  1, 2,...n  Equation  (4.3) 

For  a  two  pulse  sequence,  the  problem  has  four  unknowns  -  the  two  amplitudes 
(Ai,  A2)  and  the  two  impulse  time  locations  (ti,  t2).  By  setting  the  first  impulse  time  (ti) 
to  zero,  the  problem  reduces  to  three  unknowns.  In  order  for  V(co,Q  to  equal  zero,  C(co,Q 
and  V(co,Q  must  equal  zero  because  they  are  squared  in  and  V(co,Q.  Therefore,  the 
impulses  must  satisfy: 

0  =  A^+  005(0)^2)  Equation  (4.4) 

0  =  sm(cL)j2)  Equation  (4.5) 

Equation  4.5  can  be  satisfied  in  a  non- trivial  manner  when  the  sine  term  equals 
zero.  This  occurs  when 

HTT  flT 

C0J2  =  n^r  ^  t2  =  —  =  — - ;n  =  l,2...  Equation  (4.6) 

0),  2 

where  Td  is  the  damped  period  of  vibration.  To  cancel  the  vibration  in  the 
shortest  amount  of  time,  choose  n=l  so: 

T 

=  -^  Equation  (4.7) 
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For  this  case  Ai+A2=l  therefore: 


0 


Rearranging  and  solving  for  A1  gives: 


Equation  (4.8) 


Equation  (4.9) 


/l_^2 

Defining.^  =  %  the  sequence  of  two  pulses  can  be  summarized  as: 

1  K 

l  +  K  l  +  K  Equation  (4.10) 

0  o.sr^ 


Since  it  would  be  impractical  to  drive  a  system  with  only  impulses,  a  more  usable 
form  of  this  technique  would  be  to  combine  the  impulse  input  with  a  desired  input  such 
as  a  step  command.  This  can  be  achieved  through  convolution  of  the  form: 


f*g  =  lf(0g(t-'!^)dT  Equation  (4.11) 

0 
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The  input  sequence  is  convolved  with  the  desired  input  and  the  convolution 
product  is  now  the  new  input  that  will  cause  no  vibration.  This  process  is  demonstrated 
in  the  Figure  26  for  a  desired  command  that  is  a  pulse  and  a  two  sequence  impulse. 


0  A  D+A 

Sliaped  Coimiiaiid 


Figure  26. 


Continuous  Shaped  Input  [Sing,  Singhouse] 


The  FSM  natural  frequencies,  damping  ratios  and  damped  period  of  vibrations 
were  ascertained  from  the  system  identification  process.  These  values  were  used  in  the 
above  equations  to  calculate  the  amplitudes  and  corresponding  times  for  the  input.  The 
calculated  values  can  be  seen  in  the  Table  2. 
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X-Direction 

Y-Direction 

Natural  Frequency,  co 

1332  rads/sec 

1590  rads/sec 

Damping  Ratio,  ^ 

0.11 

0.11 

Damped  Period  of 

Vibration,  Td 

0.0048  sec 

0.0039  sec 

Amplitude  #1,  Ai 

0.5276 

0.5276 

Amplitude  #2,  A2 

0.4724 

0.4724 

Time  delay,  t2 

0.0024  sec 

0.0019  sec 

Table  2.  Input  Shaping  Values  for  Fast  Steering  Mirror 


To  test  the  effectiveness  of  input  shaping  on  the  FSM  performance  a  SIMULINK 
model  was  created  for  each  tip-tilt  direction  (see  model  in  Appendix  H).  The  model  was 
run  with  a  0.6  volt  step  input  as  well  as  a  0.6  volts  shaped  input  for  each  direction.  The 
shaped  inputs  and  FSM  response  can  be  seen  in  Figures  27-30. 
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Figure  27.  Shaped  Input  for  X-direction 
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FSM  Movement  X-direction  (mm) 


Figure  28.  Fast  Steering  Mirror  Response  For  X-Direction 
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Input  Amplitude  (Volts) 
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Figure  29.  Shaped  Input  for  Y-direction 


40 


Figure  30.  Fast  Steering  Mirror  Response  For  Y-Direction 

There  is  a  significant  improvement  in  both  directions  with  the  shaped  input;  however 
some  slight  oscillations  still  exist.  This  is  likely  due  to  slight  inaccuracies  in  the  model. 
For  instance,  the  damped  periods  of  vibration,  Td,  was  taken  manually  from  a  plot  of  the 
FSM’s  response  to  a  step  input.  Also  the  damping  ratio  and  natural  frequencies  may  not 
be  precise.  The  disadvantage  with  the  two  impulse  shaped  input  is  its  lack  of  robustness; 
it  is  highly  dependant  on  an  accurate  model.  Nonetheless,  the  performance  is  much 
improved  and  acceptable  for  this  application. 
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C.  MOTOR  CONTROL 

Control  of  the  azimuth  and  elevation  motors  was  complicated  by  a  combination  of 
motor  stiction  and  uneven  loads.  The  azimuth  motor  has  a  stiction  breakout  voltage  of 
approximately  2.7  volts  while  the  elevation  motor  has  a  breakout  voltage  of 
approximately  3.6  volts.  The  values  can  change  slightly  depending  on  the  temperature  of 
the  motors.  Additionally,  the  EARLS  platform  has  an  uneven  distribution  of  mass  with 
respect  to  the  rotation  axis  of  the  motors.  So  the  platform  was  susceptible  to  rocking 
motion  when  the  motors  go  through  any  change  in  direction  motion.  The  elevation  motor 
is  especially  susceptible  to  rocking  motion  even  with  start-stop  motion. 

To  maintain  a  stable  platform  and  keep  the  laser  on  target  it  was  decided  that  the 
elevation  motor  should  be  used  minimally.  In  fact  this  was  easily  done  since  the  EARLS 
platform  moves  only  along  the  x-direction  on  the  linear  track.  Proportional  plus  Integral 
(PI)  control  action  was  used  to  control  the  azimuth  motor.  To  keep  the  motors  from 
overshooting  and  having  to  change  direction  a  deadzone  was  created  to  turn  off  the 
motors  before  it  overshot.  The  ideal  magnitude  of  the  deadzone  was  computed  each  time 
the  system  was  run  so  it  varied  depending  on  the  current  configuration.  However,  the 
deadzone  was  usually  around  ±7.6  pixels  (4.3  mm).  In  another  words,  when  the  laser 
was  off  target  by  7.6  pixel  the  motors  were  set  to  turn  off  to  prevent  overshoot.  As  will 
be  explained  in  detail  later,  when  the  motors  turn  off,  the  FSM  is  still  capable  of  keeping 
the  laser  on  target.  Preventing  overshoot  was  particularly  important  because  the  motors 
never  had  to  change  direction  and  induce  vibrations. 

Integral  control  was  implemented  by  summing  the  pixel  error  followed  by  scaling 
the  sum  with  a  gain.  To  prevent  and  integral  “wind  up”  while  the  motors  were  shut  off, 
the  pixel  error  sum  was  reset  to  zero  during  any  operation  within  the  deadzone. 
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V.  CONTROL  ALGORITHM  PROGRESSION 


A.  OVERVIEW 

A  MATLAB  program  was  created  to  control  and  move  both  the  motors  and  FSM. 
The  code  can  be  seen  in  Appendix  1.  The  control  program  has  essentially  three  parts:  a 
calibration  sequence,  a  beacon  locating  sequence  and  a  control  sequence.  These  parts 
will  be  explained  in  detail  below 


B.  CALIBRATION  SEQUENCE 

As  mention  previously  the  camera  takes  images  of  the  beacons  on  TASS2  for 
feedback  purposes.  The  beacons  located  on  TASS2  can  be  seen  in  Figure  1 1  on  page  15. 
When  the  MATLAB  control  program  is  invoked,  the  motors  first  move  the  EARLS 
assembly  to  roughly  point  at  TASS2  so  that  the  beacons  are  within  the  camera’s  view. 
The  camera  takes  an  image  (640x480  pixels)  of  the  beacons,  locates  the  exact  position  of 
each  beacon  (the  beacon  location  method  will  be  explained  later)  then  labels  each  beacon 
either  A,B  or  C  based  on  the  distance  between  the  beacons.  The  camera  has  a  filter 
placed  in  the  lens  that  allows  it  to  only  capture  blue  light,  therefore  only  the  three  blue 
LED  beacons  are  visible  in  the  image.  The  beacons  appear  as  white  bright  spots  in  the 
image.  Once  taken  the  image  would  look  similar  to  Figure  3 1  below.  From  the  known 
distances  between  beacons  the  program  computes  the  number  of  pixels  per  millimeter  in 
both  the  X  and  y  directions  on  the  testbed.  This  ratio  will  be  used  in  the  control  sequence 
to  relate  an  error  in  pixels  to  a  physical  movement  in  millimeters.  For  accurate  results, 
TASS2  should  be  level  during  the  calibration  process.  Also  the  code  has  a  place  for  the 
user  to  define  the  x  and  y  offset  from  beacon  A  to  the  receiving  telescope.  The  offset  is 
determined  by  physically  measuring  the  x  and  y  distance  (in  millimeters)  from  the  beacon 
to  the  center  of  the  telescope.  These  values  shouldn’t  be  changed  unless  the  beacon 
assembly  or  telescope  position  has  changed.  These  millimeter  offsets  are  converted  to 
pixel  offsets  via  the  aforementioned  ratios  and  used  to  compute  the  position  of  the 
telescope  as  illustrated  in  Figure  32. 
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Figure  31.  Cartoon  of  Camera  Image  of  LEDs 


Figure  32.  Cartoon  of  Camera  Image  of  LEDs  with  Telescope 
Location 


44 


Once  the  receiving  telescope  position  is  established  the  code  is  capable  of 
accounting  for  TASS2  rotations  in  the  X-Y  plane  simply  by  computing  the  angle  of 
rotation,  p,  then  measuring  the  offsets  from  the  A  beacon  as  seen  below.  The  code  also 
has  a  place  to  input  the  laser  offset  from  the  make  the  laser  point  at  the  receiving 
telescope  with  zero  error.  This  laser  offset  accounts  for  the  lasers  position  on  the  EARLS 
platform  relative  to  the  camera. 


Figure  33.  Cartoon  of  Rotated  Camera  Image  of  LEDs  with 

Telescope  Location 
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C.  BEACON  LOCATING  SEQUENCE 

The  beacon  locating  sequence  begins  by  taking  an  image  of  the  three  beacons. 
The  brightest  spot  within  the  image  is  identified  then  a  virtual  box  (30x30  pixels)  is 
placed  around  the  spot.  Each  of  the  900  pixels  within  the  box  is  analyzed  and  only  the 
brightest  ones  are  retained.  The  program  then  takes  this  cluster  of  “brightest  pixels”  and 
computes  the  centroid  much  like  computing  the  center  of  mass  of  an  object.  The 
resultant  centroid  is  a  single  point  on  an  image  and  the  x  and  y  position  within  the  image 
is  recorded.  Note  that  the  top  left  comer  of  the  image  is  the  origin  of  the  coordinate 
frame.  Once  a  LED  centroid  is  marked,  all  pixels  within  the  virtual  box  are  “blackened 
out”  to  prevent  it  from  being  used  again.  This  process,  referred  to  as  “centroiding,”  is 
repeated  until  all  three  beacons  are  found.  Once  found  the  beacons  are  labeled  (A,  B  or 
C)  by  computing  the  distance  between  the  beacons  and  comparing  to  the  known  pre¬ 
measured  distances. 

D.  CONTROL  SEQUENCE 

After  the  beacons  are  marked  the  program  uses  the  beacons  to  determine  the 
orientation  of  TASS2  (i.e.  the  rotation)  and  hence  the  location  of  receiving  telescope. 
The  program  then  compares  the  location  of  the  receiving  telescope  to  the  laser  position 
and  computes  the  x  and  y  errors.  The  errors  in  pixels  are  used  as  feedback  in  the  control 
algorithms  so  they  are  converted  to  voltages  via  the  control  methods  (PI  and  Input 
Shaping).  The  voltage  commands  are  sent  to  the  motors  and  FSM  to  induce  movement  of 
the  laser.  This  process  repeats  at  approximately  30  Hz.  The  Watec  camera  is  the  control 
loop  rate  constraining  hardware  since  its  maximum  sample  rate  is  30  Hz. 

Software  limiters  on  the  command  voltages  were  placed  in  the  control  program  to 
ensure  safe  and  accurate  operation.  Both  motors  have  a  limit  of  ±10  volt  references  due 
to  the  limits  of  the  analog  output  card.  The  FSM  has  a  limit  of  ±0.60  volts  (15  mm)  to 
keep  the  laser  within  the  optics  range.  Test  have  shown  that  FSM  voltages  greater  than 
0.6  volts  induces  a  movement  that  drives  the  laser  beam  out  the  transmitting  telescope’s 
optical  range  resulting  in  a  partially  transmitted  or  “clipped”  beam. 


46 


VI.  RESULTS  AND  ANALYSIS 


A.  OVERALL  RESULTS 

As  stated  above,  the  EARLS  platform  must  be  calibrated  to  determine  the  offsets 
to  make  the  laser  source  point  at  the  receiving  telescope.  The  calibration  is  done  when 
the  FSM  is  at  the  default  or  uncommanded  position  and  the  offsets  are  used  to  determine 
the  error  between  the  laser  source  and  telescope  positions  through  each  control  cycle. 
This  error  will  be  termed  the  “sensor  error”  since  the  camera  is  used  to  produce 
determine  this  error.  The  sensor  error  is  a  best  estimate  from  known  locations  of  the  laser 
source  point  at  the  receiving  telescope  since  the  EARLS  assembly  doesn’t  have  the 
capability  to  sense  the  laser  beam’s  location.  This  is  important  because  when  the  FSM  is 
commanded  to  steer  the  laser  beam,  it  moves  away  from  the  default  (uncommanded) 
position  leading  to  an  inaccurate  error  because  the  offsets  are  no  longer  valid.  In  short, 
there  is  no  direct  feedback  on  the  laser  beam  location.  To  get  around  this  problem  an 
“actual”  error  was  created  which  takes  into  account  the  mirror  movement  when 
calculating  the  error.  So  the  revised  object  of  this  project  is  to  keep  the  laser  on  target 
while  keeping  the  actual  error  to  zero.  The  actual  error  is  computed  by  converting  the 
FSM  voltages  to  laser  distance  traveled  in  pixels  then  subtracting  this  movement  from  the 
error.  The  control  program  computes  both  the  x  and  y  actual  error. 
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Operational  testing  was  conducted  by  initiating  the  EARLS  control  program  and 
allowing  it  to  acquire  TASS2.  Once  this  was  done  the  EARLS  platform  was  moved 
down  the  linear  track  to  simulate  the  satellite  moving  at  a  constant  speed.  The  x-direction 
actual  errors  from  an  operational  test  are  presented  in  Figure  34. 


Figure  34.  X-Direction  Actual  Error 

The  error  “spikes”  are  reflective  of  the  laser  moving  off  the  target.  The  greatest  error  is 
approximately  -0.5  pixels  which  converts  to  0.30  millimeters.  This  is  an  acceptable  error 
since  the  laser  beam  remain  within  the  receiving  telescopes  optics. 
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Figure  35  shows  the  aetual  errors  in  the  y  direetion. 
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Except  for  the  transient  segment  between  zero  and  approximately  one  seeond,  which  is 
when  the  laser  is  initially  moving  on  target,  the  y  error  remains  at  zero. 


B.  SYSTEM  PERFORMANCE  IN  THE  X-DIRECTION 

The  control  sequences  for  the  FSM  and  motors  are  tuned  to  eompliment  eaeh 
other.  They  are  adjusted  such  that  when  the  error  is  small  enough  to  be  within  range  for 
the  FSM  to  eorreet,  the  motors  turn  off.  The  FSM  can  generally  correct  an  error  less  than 
7.6  pixels  (0.6  volts)  in  either  direction  before  the  laser  beam  starts  to  “elip.”  Once  the 
error  approaches  7.6  pixels  the  motor  turns  on  and  the  mirror  able  to  unload. 
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The  x-direction  results  from  an  operational  test  are  presented  in  Figure  36.  The 
figure  highlights  how  the  FSM  and  azimuth  motor  work  together  to  minimize  the  aetual 
error. 


Figure  36.  Azimuth  Motor  and  Fast  Steering  Mirror  Voltages 
for  the  X-direction 


This  complimentary  control  has  the  added  benefit  of  never  allowing  the  laser 
beam  to  be  clipped  (i.e.  voltages  greater  than  0.6  volts)  while  never  allowing  the  motors 
to  overshoot  the  target.  Additionally,  with  this  type  of  control  sequence,  the  motors  are 
pulsed  in  the  most  ideal  manner,  slightly  above  stiction  voltage,  which  doesn’t  induce 
excessive  vibration. 

If  the  system  was  performing  ideally  the  FSM  correction  in  pixels  should 
precisely  follow  the  sensor  error.  Otherwise  any  deviation  between  the  FSM  correction 
and  the  sensor  error  would  signal  that  the  FSM  wasn’t  able  to  account  for  the  error. 
Figure  37  shows  the  both  the  sensor  error  and  mirror  movement  in  the  x-direction. 
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Figure  37.  Comparison  Between  Error  and  Mirror  Movement 
in  the  X-direction 

The  FSM  correction  does  follow  the  sensor  error  except  when  the  red  lines  are  seen. 
Consequently,  it  would  be  expected  that  at  the  point  of  time  when  the  red  lines  are  visible 
the  actual  error  would  be  greater  than  zero,  which  is  confirmed  by  viewing  Figure  34  in 
the  Overall  Results  section. 

C.  SYSTEM  PERFORMANCE  IN  THE  Y-DIRECTION 

Since  the  EARLS  is  moving  down  a  level  linear  track  without  changing  altitude, 
the  elevation  motor  is  rarely  used  during  operation.  As  a  matter  of  fact  it  is  desired  not  to 
use  the  elevation  motor  because  it  tends  to  induce  excessive  rocking  of  the  EARLS. 
However,  the  system  will  have  some  slight  rocking  when  moving  down  the  linear  track 
so  the  intent  is  to  correct  the  y-direction  errors  induced  by  this  motion  with  the  FSM 
only.  Figure  38  compares  the  y  sensor  error  to  the  FSM  movement. 
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Figure  38.  Comparison  Between  Error  and  Mirror  Movement 
in  the  Y-direction 

Except  the  initial  acquisition  of  TASS2  there  is  no  deviation.  So  the  FSM  is  able  to 
correct  all  the  y-direction  error.  This  is  also  confirmed  by  Figure  31  in  the  Overall 
Results  section  which  shows  no  actual  error.  Additionally,  the  below  plot  confirms  that 
only  the  FSM  corrects  the  y  error  since  the  motor  voltage  remains  at  zero. 
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Figure  39.  Elevation  Motor  and  Fast  Steering  Mirror  Voltages 
for  the  Y-direction 
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VII  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSION 

The  purpose  of  this  thesis  was  to  make  the  EARLS  platform  operational  by 
developing  a  tracking  control  system.  The  goal  was  to  point  the  laser  beam  at  TASS2’s 
receiving  telescope  and  maintain  the  laser  within  the  telescope’s  limits  in  the  presence  of 
structural  disturbances.  To  accomplish  this  two  control  algorithms  were  developed,  one 
for  the  motors  and  one  for  the  fast  steering  mirror. 

The  mathematical  model  for  each  motor  and  fast  steering  mirror  were  determined 
through  experimentation  then  presented  in  the  form  of  a  transfer  function.  Tracking 
control  methods  were  developed  for  these  components  and  implemented  into  a  MATLAB 
program  to  form  the  EARLS  control  system.  The  motors  were  controlled  with  a 
proportional-plus-integral  control  algorithm  and  the  fast  steering  mirror  was  controlled 
with  an  input  shaping  algorithm.  Operational  tests  of  the  EARLS  system  demonstrated 
that  the  control  system  was  able  to  accurately  keep  laser  source  on  target  within  the 
receiving  telescope’s  limits. 


B.  FUTURE  WORK 

Although  the  tracking  system  for  the  EARLS  testbed  worked  exceptionally  well, 
it  was  only  one  piece  of  the  overall  picture.  The  EARLS  testbed  was  intended  to  interact 
with  TASS2’s  payload  which  wasn’t  operational  at  the  time  of  this  theses  research.  Once 
TASS2’s  payload  is  operational  the  control  system  can  be  refined  or  new  control  methods 
can  even  be  explored.  This  would  be  a  perfect  and  meaningful  opportunity  for  a  future 
graduate  thesis. 

Also,  is  some  equipment  upgrades  were  made  the  control  system  would  work 
much  more  efficiently.  As  noted  previously  the  Watec  video  used  for  feedback  has  a 
cyclic  limitation  of  30  Hz.  Replacing  this  camera  with  a  faster  version  would  open  the 
door  to  more  control  opportunities  providing  higher  control  bandwidth.  Active  control  of 
EARLS  structural  vibrations  is  also  a  possibility  with  the  use  of  vibration  sensors  on  the 
MTSTF  structure.  On  another  note,  if  the  laser  beams  position  on  TASS2’s  testbed  could 
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somehow  be  fed  back  to  the  EARLS  control  system  the  FSM  control  loop  could  be 
closed  further  improving  performance. 
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APPENDIX  A 


LINEAR  TRACK  DATA 


Technical  data 


2  Technical  data 

2.1  Product  construction  and  description 
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profile. 

^  elaal  i4npe  14}  are  iTtlad  inta  tha 
prahiB  ol  E}i«  venlon  wtot  s.i«Bj  raiievi; 
Ttw  profile  can  t>4  supplied  In  cro»- 
secbsfti  ef. 

*  eg  K  WHnm  (HPLASfl) 

*  1  SO  K  is2!&mm  rHPtJM^Ol 

*  1  ad  j{  tSAmm 

Twg  «i34Knbly  igrw¥e4  «ri  louled 
on  vw  hvD  sides  and  on  the  Udhom 
tlwse  can  ba  u-sad  tn  AeeofdAnca 
with  piN.^a  T^tim  (9  »d. 

dIEI&fVBl  mechanlcar  comixMrwcits  and 
bp  CMUiect  i«'d4ral  linear  eetuBlan 
When  op^blned  wHih  Ihe  co^ring 
proni*  this  r^oms  ducts,  t.g 
Eh*  inlEiHlar  cabta^. 


The  carriage  |2J 

Th*  ■luhibniliinl  c-flmeg*  proPi*  hit 
also  beep  optiiTiiiied  vfing  FEA 
rn«un[»as.  Tm  plamc  ar  sl»el  niil«n 
Cmowwivd  on  rollwr  bearings  and  In- 
tirlcjil0d  tor  tifii)  are  wi  the  ec- 
^mtrlic  ba  elimlttpBtia  play  on  efil  aides. 
The  carriage  can  Es*  aupplied  in 
sees  Bs  the  slandard  carrlagfl  wrth  1^ 
rallara  or  ejdende-d  CAfrsga-  mWi  24 
rplltrt 

The  teii^iAniag  statian  j3] 

An  SBSJty  ecceasible  tetftslDnlng  sEb- 
Dofi  wtilcli  It  tHnpl*  Eo  milncam  an4 
assemt^e.  II  Is  UBS<f  Id  s-et  ihe  necos- 
saiY  Eenilon  oT  the  timing  belt  asd  Its 
ellgnniefll  ifhpra»fB  b>  1ti«-  pulle^j. 

The  drive  st^tk^n  [4) 

The  HPLA  t*n  6e  tfaliverecf  wri* 
numerous  diw  opEions  Every- 
Ihing  is  ptir&sibEe  from  ihe  pulley 
mounEKi  geartox  sha^ 

through  a  fully  tupporled  hallow 
^haft  up  Id  a  driu'e  shaA  on  lelt  on 
rpght  Of  Oh  both  sides 

The  timing  belt  m 

The  Elihifig  t^tt  \i  Urb-fnee  irib  »  ri9^ 

InEorcBd  by  I  ntagral  sleal  wirva ,  Eher«- 

by  thiurlng  maximum  Triwi  ipeads 

And  rej>e«tabllity. 


Claitiping  of  titning  belt  (S> 

Th*  bfrnifig  hell  clamping  angle  ena 
Eh*  larga  area  cf  1h«  damping  guar-^ 
anbtee  e  secure  connection  between 
Pie  Beni  ng  ben  end  #i«  cirriag*. 

The  clamping  tyiEam  ilb>^  Ehe  Hiti- 
ing  halt  to  be  repriaced  '.^/ttlKHJl  the 
load  anacJvnanE  ipiila  havng  to  ba 
dlsmantfed.  This  means  that  aEtac.1^- 
menls  Oq  noE  nerfiiaMy  need  to  bs 
re  moved. 

Tha  Icrad  attschniint  pi {7} 
The  lo^ignudinei  -grooves  unegrew^ 
bh  the  ibp  Of  ifie  pii^e  offer  roeoy  bp- 

t]4ni  fci-  lha  svsamblyr  of  beH^- 

mefits.  Whan  used  In  conjunction  wltSi 
Our  as'mplng  proANri.  this  bIId^vs  for 
Simple  iPCBr^ratwh  In  a  multiple  «la 
syslem 

SimiM-  and  adjusiabie  aiiechmeiit  or 
Dperatfig  corns  or  s>mch  lugs  Is  pro- 
vld«Oi  by  means  or  laEeraJ  and 
ludsiel  groo\r«. 

Hle:ghi  end  boh  poinn  ii4  uri«ffeccei9 
If  Eiie  iteei  itPip  ni^er  it  aheew  at  a 
inbH  d»it- 
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Technical  data 


2.2  Technical  data 


HPLA$iz« 

Unit 

HPLA080 

HPLA12a 

HPLAIBO 

Timing  inttgnvi 

Timing  tMlldrlva 

Timing  mt  err1v»  I  Rieh.^nd{)lnfen 

Rjflkr^ar  I  SMrcfc 

Plztc  n#tr  1  SMnatr 

FMc  wtitm  ^  3M  n4>r  1 

1  asvi^xTt 

Weight  and  mass  moments  oi  inertia 


WAlgitt  Dt  base  unll  Vivitti  2era  slrDke 

HPLA  wllh  starKfarid  carfiage  (St 

g.o 

G.6 

ia_s 

1&.8 

ds.e 

53.4 

71.8 

as  abOYe-  wim  stMl  strip  &ovar 

ng 

e.8 

7.5 

20 2 

21.6 

57.2 

61.6 

78.4 

HPLA  wllh  ej(tandad  carria^  i;e|i 

7.8 

g.6 

23_5 

25.2 

67.4 

7Z.6 

68.6 

as  nb^e-  with  stMl  strip  c>ovtr 

hg 

se 

5.5 

25 2 

27.t 

74.8 

80.& 

95.2 

Camagt  +  load  all..  Plata  cs> 

»ig 

1.S 

l.S 

5.5 

5.7 

114 

1 1.3 

9.9 

at  Abovt-  with  4tMi  ttfip  Mvor 

1.7 

1.0 

68 

6D 

123 

12.6 

12.5 

Camogt  +  load  all.  iplaEo  iB) 

2.4 

2.6 

3.5 

8.5 

'"mTs 

2LQ< 

17.2 

at  abovg.  wiih  ateai  itfiD  uvar 

kg 

2.e 

2.6 

3.8 

9.2 

21.1 

21.3 

19.S 

wusht  oT  Olive  moour# 

« 

- 

20.0 

Wngiht  p.  milne  &taM.  lenglh 

«.a 

7.2 

13.S 

154- 

29.2 

134 

31.4 

at  Above  wllh  ote«l  strip  oovar 

kg/rn 

6.1 

7.3 

13.7 

15.5- 

29.4 

83.6 

31.5 

Maw  monwni  of  Ingrlli  reiatib  to  th9  biive  sNaR  ^p& 

t 

HPLA  vfiih  stanrfftret  carriage  |S ) 

j 

16.0 

tp6.6 

13G 

14Q 

663 

605 

646 

at  ebove  -.vllh  steal  strip  iie';ar 

i^gem 

i7.a 

T6.4 

U2 

T46 

725 

743 

693 

HPLA  wllh  extandadr  esrriaga  cEf 

_ j 

.23.6 

24.7 

101 

Tse 

1074 

1107 

793 

at  dbovfr  wllh  steal  strip  oo^r 

kgcrrr 

25.4 

2^.5 

107 

204 

1121 

1154 

845 

Travel  paths  and  spaeds 


Masdmum  travst  spwd 

rnTs 

.5.0 

Maximum  acCfileraUon 

rTT's’’ 

10.0 

Ua^dmum  trSvBl  path.  standarO- 
tarr.  (S/T)  ^^wlth  one  pfofila  bar 
aa  Above  with  steat  strip  oovar 

■ran 

£610 

£540 

5590 

5520 

9bG0 

9470 

9S3C! 

9440 

9440 

S24D 

9400 

9200 

6080 

668D 

Ma^Omum  travil  path.  exlanOtd 
carr.  (E/F)  ^''wigh  on#  prollla  bar 
a&  above  with  steet  sbip  Dover 

nwn 

£4G0 

5390 

5440 

5370 

93G0 

9270 

9330 

9240 

9140 

0940 

9100 

3900 

0580 

6380 

Geomatrjcal  data  of  guide  profile 


Cfo»-»ction 

mmxmm 

60  .K  60 

i20x  120 

160  i60 

MomenlDr  inertia  1^ 

cm' 

139 

724 

3610 

Momtnltirintrua  l^ 

cm' 

165 

83Ck 

4077 

E-modutttialurriiihluni) 

Nfmin’' 

0.72  •  10^ 

Fo^ce3^  torques  and  efficiency 


Nominal  drive  torguB 

Nm 

20.5 

74.2 

244 

58 

Ivfasamum  drive  torque 

Nm 

47.4 

131,4 

aee 

58 

Nominal  ihruat  force  wtih  Pully 
Supported  holldw^ahaft  bearing 

N 

925 

169G 

3733 

- 

Tboisi  force  {efTectrve  load) 

N 

eae  pa^  IP 

free  page  1 1 

see  page  12 

1300 

Repeatability 

nan 

±  0.2 

±  0.2 

±  0.2 

±  0.05 

Efficienev 

% 

95 

95 

95 
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Data  Of  puH^v  and  tin^ii^gi  bolt 


Travel  dislaoc#  per  revolution 

mmnJ 

16Q 

270 

420 

230 

Number  of  teelfi  on  puiiev 

13 

27 

'21 

28 

Tiffiina  b«it  widih .'  pitch 

mm 

2Sno 

32nu 

56i20 

42  MD 

Weight  ffTbmtna  belt 

kg/m 

0.166 

0.213 

0.560 

0.2S'f 

Respbns#  radnus  of  the  pulley  e  r 
the  dffve  (R*) 

m«n 

23.7 

43.D 

363 

44.5S 

FJ  AdWIkmol  tnUtA  WnUtmM  4t  iwfU  Out  l6  khH  MtO  wit^  itonirg  bell  {1^  endin'  l.A} 

2)  ilop^.  toffyeCKfi  uti  b#  uho  Iw  ko^  brmi  ^tH.  Sonw  i«4£kI]mh  hdv€  »  b«  <«Mio«r«d  nunnidn  p&M  arN«  tArt|ii«. 

qiHfl.  acccterabofi  and  l^qi^aiaMily  ('Sh:  cTiafiBer^  ItiJ  Feir  acXiabiri  ik^  nich-j:rf  pi.nhin  ir>e  InvcF  h]h£^kk  hi  unl«nillN]  {ili  Far  jk  tbe  knur 
achjbbrf  &  itcincEflKdJ  -  cH^cMnlg  ihliy  nA  |>onei'  *i|Hrl  Fhniri  Drit  Ahe 


j— rtthiticaj  it  iv*4  J  -urti  tv  t*inr  wtr  ibw  4-1 .  Dvu  r«r  i  'Mg*  #1  bti^ wi  -1C’‘C  * 

tm  tt^rvilciP  tiiKi  apjriin  unifif  lUmfvti  ^^rt^rtHini  iriif  -OnUgr  m  Vii  irtumiadllir  wraElug  n\vi§  in#  nahjrl  vt  K?^d.  li  Uw 

iii*  i»«.  n  mirti  b*  ¥tritt*a  in  wnn  pi*  «P  gn  yiic  Md  licnniul  f-ur^urdi.  Alwiwr  iir^ni*  ium  iuvi »  b* 

nitucid.  PlisHi  cntitactm  bn  Dii  cjm  [yr  doubt. 
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APPENDIX  B 


PRIME  MOVER  DATA 


Catalog  a0<10-5i'lji3A 

NeoMetlic  ^  J  Series  SERVO  MOTORS 


92  rnm^  Encoder  Feedback,  SpeckflcaUons 


Firarnniur  S^pnfKri  IJt^  Pt»21F  NMZ2G  NDiZ3H  NQtZ3K  MOt^  NOSEIK 


Sum  Taiqtid 

B-n 

ISjg 

2T.4 

24.3 

41  3 

4C0 

54.-6  j 

54.9 

«i-n 

4J2 

453 

660 

6-50 

673 

076 

WTl 

171 

ITi 

3.-D9 

317 

4,62 

4  55 

611  1 

0  14 

Sun  Cuffont  Cfl¥iiniiM-'  ** 

Unprs  P«3k 

4  7 

6.4 

■4.5 

101 

100 

17.4 

lO.t 

16.2 

5l0l  Cwe^t  OorattouctH.^-" 

Uar«[>l 

AmpiOG 

4  1 

17 

1.6 

6  7 

6.6 

IS! 

9.1 

11.2 

FKil^TcrqMC^ 

V 

i&« 

46  7 

3S.e 

615 

723  J 

1710 

163,6 

164  J 

M-to 

744 

7AT 

13I2T 

11S6 

1970 

1»51 

2&Z0 

26» 

H-n 

5.72 

123 

635 

7106 

13.66 

1034 

10.41 

FiKife  CuTiirl"'* 

Amp4  Fvflh. 

U5 

1&? 

lOS 

303 

290 

6^2 

12.  S 

160 

CLTrirr^' 

^qnp) 

AmpsOC 

IZ-J 

171 

2&9 

262 

25^ 

4^2 

23  2 

39,6 

I^C€<JSp«(P 

rpm 

640Q 

7500 

4650 

7J0fr 

4706 

7500 

-3750 

SZiCi 

^;u^^^m(  ^  PJtwI 

Anrp* 

4  1 

12 

6.4 

70 

60 

lao 

97 

124 

(UdEii 

sw 

a.^ 

4.5 

4.S 

6.0 

T.4 

10.  a 

0.41 

19.7 

To«qw« 

\ 

B-ln 

11  a 

113 

Xk4 

16.3 

»4 

266 

4HS 

391 

«-n 

101 

J26 

260 

40T 

1^1 

6» 

026 

rm 

1.1^ 

1.27 

2.26 

1.32 

341 

3.23 

4,59 

4.13 

SNUl  PiQ«w  *Ra(fld  5ps«d 

5V 

TW4 

1121 

1404 

1650 

2567 

1350 

2411 

ViWtaO/^ 

fl.43J 

<i.m 

Q&S4 

4.34a 

i>64l 

*.305 

06S7 

0.410 

wotJiflo  c-yr.i!vt“ 

VdK'KRPU 

11  72 

323t 

53  .?2 

17711 

^55 

31  01 

5089 

i^.2Z 

Tgfiqur  C^^bBrt* 

Hjiawt 

^-tvAnrpF^ 

37$D 

^.10 

44. 1 S 

^22 

3746 

W.5? 

57.64 

hmfAiYV  FV;ik 

4.24^ 

0.177 

4.30» 

1^.444 

0.263 

D5&4 

0.403 

T^Tfiw  COrr^J^^’‘ 

477& 

5A90 

^6  46 

47  1* 

WjOJ 

$6.66 

t«A' Aitip  DC 

C4£3 

4.104 

0441 

*.isr 

43.635 

o.3oa 

Q6S1 

04$6 

ns^l»arK4* 

R 

CKlfTW. 

172 

1A4 

2.32 

9.« 

12a 

9.42 

122 

0.62 

Hwaj^caw  9* 

L 

tllH 

1?.i1 

14.72 

i.’it 

14.05 

4.» 

zojSdi 

1*il 

UfiKLAun  Bus 

vrSEi  DC 

340 

IB 

146 

IB 

340 

340 

740 

340 

in«TTi.if  wnd-An* 

R;  w-3 

CJ'fm 

I.M 

1,04 

O.-PI 

601 

07 

a? 

06J 

0.62 

Hrtw  Ccri^Tf^ 

jl/35 

11.4  T 

61 .56 

5203 

fiT.yD 

66-.64 

H4il 

34.62 

unr^Wi 

fl.flO 

0.3£? 

4.3*1 

1>.4?1 

*40G 

0690 

0.66^3 

B 

AZ-n^Kirpm 

DA 

D.E 

fr.S 

04 

1.1 

11 

1.1  1 

1.4 

ianitupii 

E-3 

74  t-3 

5.6  ^6 

64  £-3 

M5-3 

7.1  E-3 

04:e-3 

*e£-i 

SLSK  F«E£i^ 

Th 

2A 

4.6 

44 

5i4 

S4 

6.6 

4.6 

Mm 

kA  E^2 

1.SE2 

14  E^Z 

3.4  Zr2 

3..4E-2 

la  E-2 

4.6  Er2 

4.6  £2 

Maa  Truiwii  TV*  Ca-cid^ 

^4. 

mutual 

21.4 

31.4 

» 

30 

35 

11 

sr 

17 

EtocETK^J  Tmvt  CwKiare 

miltHKS 

4.64 

4.43 

6.34 

6. 44 

rifct 

11  ja 

t6.S9 

1495 

NeflWwic  lAxh.  T^ne  orart 

nsii«c^ 

D.0 

&,0 

Sh.S 

05 

04 

ff.5 

Oi 

9.4 

J  SatttMwiri  “Hnw  Ccnsufi 

mlisacs 

Tan 

10.0 

1.9 

10 

24 

2.4 

um 

tO'A 

HiwnHilwit  Twflup  Oil  aiK^i" 

wcwirts 

4e 

40 

?0 

19 

61 

51 

41 

FMk  Tgcuwp 

^JKWf5. 

It 

IT 

13 

13 

16 

16 

’S  i 

16 

HwW^nc  lifflw  KMfiMi 

J 

B5-H-MC? 

It  E-4 

3  .6  E  4 

#  2  E-l 

62  E-4 

SiBE4 

6a  E-4 

1  1  E-3  1 

1  1€~1 

kg-rn? 

4  1  EA 

4  1  E-5 

7.0  E-5 

T.O  E-5 

1  0E4 

10  E-4 

1  lE-4 

1.1  E-J 

J  Sdm  ^DCdriHita 

J 

C-n-iflC^ 

UEA 

>4^it 

it.l  E-l 

4.^  M 

j.a  E-i 

hlTA 

WA 

hj-rir' 

I  G  E^ 

4eE-i 

5-1  E-i 

6.1  E-4 

6  4  E-4 

6  4  E4 

Wfk 

H>'A 

HiBnE»f  or  f^gfn 

Wp 

4 

4 

1 

i 

4 

4 

4 

4 

bv4M4UK 

&.1 

S.1 

11.7 

11.? 

15.1 

1S.1 

19.-0 

140 

kg 

3^1 

u 

6.6 

43 

60 

60 

3-a  1 

$.2 

J  5tiia&w«igpi 

ttA 

DO 

9l0 

13.5 

1i.S 

1£0 

ISO 

UfA 

tVA 

ko 

4A 

4  A 

4.1 

61 

T.J 

7  1 

WA 

WA 

MtnBT^  CbL% 

H 

« 

H 

M 

■4 

H 

H 

r  m  tS^C  vmdn^  ranpariej*#-.  moaj  coivwwa  ro  i 

^  AjtVlLFlt  flOfif 

ffnftiffir  (Jffflce  cufWJ*5  #Kr  ndrijUH  Jjf  Ji% 

2  MiJrtTtm  spssrffe  7S®  fflW  a»  iSi»  lEncwJflf  fir 

iMdC?  n  ddKXKJW 

fcffvs^  s¥Je*d‘4]s»r«s«:|3itesw  caf  factory 

J  M?asLRjflTifw  »ijJ».  ^/r  fffb 

4  VMic  &  tifsim  imvv. 

5  v-sw.  UfjHcHm.  *T^JUeriW? 

6  ^iitia}vf4(viinffrsn7p^Mi4tfnj^h0^S^C<}rhisbe^fv^CtxT9fj[K 
Jip^Qd 


t  PC  ClMif  a  flTJTNiarprtaW?  J  AiW 

Cft^rmjtoOM 

t  ^uir  mtisMtffiiFart  J 

mpffcr 

f  iM'-^  2  Emo^  rp^C^ort  ¥iiPi  MiaJ 

ktfhng  E«i9V  ar 

f  Z  dlrd/OT  ntf/l  J  r.^<Tf  uMC  nffi  iivmi 

wtatlrtp  tliwiid  Jf  t 


Tli^ss  sp&^ftcitiion^  ^ine  on  rAear-er^il  fnotot  peifofiitKinc^  mkS  Jie  neH  spectHc  to  tmy  Antplit&f. 
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APPENDIX  C:  CONTROLLER  DATA 


catalog  ec»o~4jusA 

6K  Controllers  6K  CONTROILE  RS 


1 


H  Specif!  ea|iDn& 

■ 

Paramflier 

Psramfllaf  Typa 

Value 

Power 

mpm 

ii  VDC.  2Amp.  UMf  StSHAst 

HMwciJ  pewcT  nn^  pm  l«t|d!i-d  r«  IWi  iam 

fAT  Dd  JlK 

EnvirDfiiriBnlBd 

DfMfaing 

S5*Ml32*f  KPlflSffCI 

aiVE^V^  ttniiiwnrtip*' 

KUlMly 

nt  M  iWi-±i^arnine 

Pwfwinancn 

C;«fTKni|td 

*r-  iww  s  Dr«4tofl 

LOfMl^ADH  pd  4jUS 

Swvo  UpdetB- 

As  roU  *S  62.5  ilS'AS 

Eucoasr 

Fws  Eh^w  aujdr*tufi»  -Mwl  HH^wrwrttf  fn«»efv  aepf  i?iUMi  *ff<oinmeflaed1  w 

«rHH4]  oupou  S  VEK:  m  compubiEt 

Mai.  DequefK^  -  MtiE  txr^  quadraL^fi 

*  r-o  5f»p^  iicni  fpfcU 

Rano# 

1 14  2.0iBi.O0Q  cdu«sA«  ^0|i  A  dr-»ofjcfi  didpulj 
lie  iie«iAK»cow(^^*c1+^-  i«fV«Wi 

Inpijisi 

En^tcr-TiaiVd  b  HHTHk 

FACHiy  duTaJm  21  ^DC  wtNmg 

J^inpw  LIW-i'tfleHD  rt?  ^ULbg 

0..S-B  vDC  Meu^ 

1/1 171 1  ¥ttd4d  M^tunr^  miinJKPa 

CdnfleUTBt*  0*  nput^  if  nsi  needed  B% 

Inggnr  In^to. 

9  Ot*  AKl  A  AKI.  1  7  dtl  AK't  A  BlOa 

PaaM^  u  34  vDC  :>ai^<ing 

IUT4p4f  TlRiG-P  »  GtID  lor  EFUMlf 
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APPENDIX  D:  VIDEO  CAMERA  DATA 


n 

^fatec 

WAT-  902H  2/3  ULTIMATE 

_ 

SPECIFICATIONS 


Model 

WAT-902H2  ULTIMATE  (EIA>  ] 

!  WAT-902H2  ULTIMATE  (CCfR^ 

Picfc-up  elemenl 

1/2"  ihtediinie  transfer  CCD  image  sensor 

Huinber  of  Eolai  pistels 

Sri(H)^  SOS^V) 

7954H)  59etV) 

Number  of  effective  pixete 

7tS8(H}  X  494(V) 

752(H)  X  532{V) 

Unii  cell  size 

8.4utn(H)  «S.6um(V) 

8,-6um4H)  *  8,3vffl(V> 

E\V.  1/eOsec.^  moWOO  sec. 

Ell:  liSOsec,-  moOOQO  sec. 

EI2: 1^100  sec.  -  in GOODD  sec. 

EI2: 1/120  sec.  -  1/100000  sec. 

Shutter  speeds 

FL:  moo  sec. 

FL:  1/120  sec. 

OFF:  t/60  sec. 

FL:  1/SD  sec. 

1/250,  1/SOD.  1/1000.  1/2000. 1/5000, 1/10000, 1/100000  sec. 

Minimum  illumiFialiDn 

0.0001  [xFl.4 

Model 

WAT>O02K3  ULTIMATE  fEIA>  | 

1  WAT-902H3  ULTIMATE  fCCFRJ 

Pick-Up  elomenl 

li3"  laterlprie  transfer  CCD  image  sensor 

Humber  of  Eotet  pixels 

508<V) 

795^H)  ^  5i6-(V) 

Number  of  effective  pixels 

7$S(H) «  494<V) 

752(H)  X  5i92{V) 

Unit  cell  size 

6,35um(H) «  7.40um{V) 

6,50um(H)  K  S,25um(V) 

EM:  1/60  sec.  -  inoO&OO  sec. 

El:  1/50  sec, -1/lDO.QOO  sec. 

EI2:  moo  sec.  -  mOODDOsec. 

EI2: 1/120sec.-  1/100000  sec. 

Shutter  speeds 

FL:  moo  sec. 

FL:  1/120  sec. 

OFF:  1/60  sec. 

FL:  1/5D  sec. 

1/m  1/m  mm  if2m  i/sm  1/100001.  i/iooooosec. 

Minimum  illumination 

(J,013DZte.F1.4 

CcmmQn  spwEflcafticns 

Synchronising  s/steeifi 

Internal  sync. 

Video  outpoft 

1Vp=p.  75olinns.  unbalanced 

Resotiftion  {H) 

570TVL  (Center) 

SN  reEio 

More  than  &DdB  ( AGC  OFF) 

AGC 

:,1':HI:5.G0dS  :l'LO:  S.32d&  ilMeCfS-SOdS) 

Back  light  compensation 

1  OFF(Defaun)  2[C«nler 

3  Lower  ^Cerrter  +  lower 

Gamma  correction 

•1  HI(v^sD.35.)  iS'LO  (vfeO.45)  ':3'OFF{y^1) 

Power  supply 

[>ci2v±ia% 

Power  consumption 

1.32W  {110mA) 

Operating  temp^rate-re 

10*C^ 

■  +40''C 

€iord^  tempe'/dlufe 

-30^C- 

■  +70’C 

Dimensions<W"H>fL) 

55,5  «  40 

63  (mm) 

Weight 

apprcK.  96g 

Oesigri  ^nd  specifcCi^trOn^are  sul:3jei:rt  to  change  without  nolico. 


Watec  Co.,  Ltd.  1  ^2  PCI6021 5E-1 
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APPENDIX  E:  MOTOR  TRANSFER  FUNCTION  DATA 


Motion 

Direction 

Elevation 

Up 

Elevation 

Down 

Azimuth 

Back 

Azimuth 

Forward 

km 

0.0127 

0.0136 

0.0155 

0.0153 

0.0904 

0.0710 

0.0728 

0.0772 

0.0127 

0.0136 

0.0155 

0.0153 

0.09.S  +  1 

0.0715  +  1 

0.07285  +  1 

0.07725  +  1 

0{s) 

0.0127 

0.0136 

0.0155 

0.0153 

Kn 

.5(0.095  +  1) 

5(0.0715  +  1) 

5(0.07285  +  1) 

5(0.07725  +  1) 
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APPENDIX  F:  MATLAB  CODE  FOR  DETERMINING  THE 
MOTOR  TRANSFER  FUNCTIONS 


o 

%  Motor  Measurements .m  -  Measures  &  plots  motor  position  and 
%  angular  velocities  of  each  axis. 

o 

o 

%  LCDR  Scott  Johnson,  Jan  06 

o 


o  o 
o  o 

o 

-k-k-k-k 

%  Elevation  Up  Measurements 

o 

k  k  k  k 


%close  all 
%clear  all 
clc 

%kkk  Prep  axis  for  test 

HomePosition; %  Send  the  Source  to  the  home  position, 
pause ( 1 ) ; 

BAO_Motion2 ( 0 , 5 ,  0 , 0 ) ; pause ( 8 . 0 ) ; BAO_Motion2 ( 0 , 0 ,  0,0);  %  bring  source 
all  the  way  down 
pause  (2 ) 

%kkk  Initialization 
%  5V=6.5s 

voltage  =  10;  %  motor  voltage  for  test 
t  =  3.5;  %  period  of  test  in  seconds 

t  =  t/0.01;  %  segment  test  period  time  segments  to  be  used  in  arrays. 

See  for  loop  below 

Time  =  zeros (l,t);  %  time  array 

read  =  zeros (l,t);  %  encoder  reading  array 

encoders  =  BAO_Motion2 ( 0 , 0 ,  0,0);  %take  initial  reading 
read(l)  =  encoders (4);  %  read  encoder  count 

Time(l)  =  0;  %  initial  time  is  zero 

Start  Test 


BAO_Motion2 ( 0 , -voltage,  0,0);  tic  %start  motion  &  time 
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for  %  carry  out  readings  for  f^O.Ol  seconds;  period^pausc^i (max) 

encoders  =  BA0_Motion2 ( 0 , -voltage,  0,0);  %  read  encoders 
Time(i+1)  =  toe;  %  read  time 

read(i+l)  =  encoders (4);  %  choose  elevation  encoder  reading 
(counts ) 

pause  (0.01) 

end 

BAO_Motion2 (0, 0,  0,0);  %  Stop  motion 


^-k-k-k-k  Calculations 

dX=diff (read) ; 
dT=diff (Time) ; 

vel  =  dX./dT;  %  velocity  in  counts/s 

w  =  vel .  "^  ( 1/572 96)  ;  %  angular  velocity.  1  rad  =  57296  counts 
Plots 

%  First  need  to  calc  time  interval  midpoint  for  each  angular  vel 
for  i  =  1 : t 

w_time(i)  =  Time(i+1)  -  dT(i)/2; 

end 

%  plot  time  vs  angular  vel  (rads/sec) 

plot (w_time,w) 
xlabel('time  (sec)') 

ylabel (' Angular  Velocity  (rads/sec)') 

title ([' Elevation  Up  Instantaneous  Angular  Velocity  (rads/s)  for 

Voltage  =  ', num2str (voltage)  ,  '  V']) 

grid 

o 

o 

o 

o 

%  %  plot  calculated  velocity  response  curve 

o 

o 

%  Km=0.012 
%  a=10 
%  Tm=0.057 

%  Wt^Km'^a'^  ( 1-exp  ( -w_time/Tm)  ) 

%  hold 

%  plot (w_time, Wt ) 

%  Wt2=Km^a^ (1-exp (-Time/Tm) ) 

%  plot (Time, Wt2 ,' c ' ) 


%  plot  time  vs  angular  vel  (degrees/sec) 
%  figure 

%  plot (w_time, w . ^ ( 180/pi) ) 


68 


%  xlabel ( ' time  (sec)') 

%  ylabel (' Angular  Velocity  (degrees/sec) ') 

%  title ([' Elevation  Up  Instantaneous  Angular  Velocity  (deg/s)  for 
Voltage  =  num2str (voltage) , '  V']) 

%  grid 

%  plot  time  vs  position  (rads) 

%  figure 

%  plot (Time, read. 757296) 

%  xlabel ('time  (sec)') 

%  ylabel (' Position  (rads)') 

%  title ([' Elevation  Up  Position  (rads)  for  Voltage  = 

', num2str (voltage) , '  V']) 

%  grid 

%  Plot  calculated  position  response  curve  and  velocity.  Need  to  use 
simulink  file 
%  elevation_up . mdl 

hold 

%  plot ( sim_time, -0 . 18  +  Position,  'r') 
plot ( sim_time, velocity,  'r') 

legend (' Measured  Data ',' Transfer  Function') 

%  plot  time  vs  position  (degrees) 

%  figure 

%  plot  (Time,  (read.  757296)  "^ISO/pi) 

%  xlabel ('time  (sec)') 

%  ylabel (' Position  (degrees)') 

%  title (' Elevation  Up  Position  (degrees)  for  Voltage  = 

', num2str (voltage) , '  V']) 

%  grid 


o 

-k-k-k-k 

%%  Elevation  Down  Measurements 

o 

-k  'k  'k  'k 


%clear  all 
clc 

%kkk  Prep  axis  for  test 

HomePosition; %  Send  the  Source  to  the  home  position, 
pause ( 1 ) ; 

BAO_Motion2 ( 0 , -5 ,  0 , 0 ) ; pause ( 4 . 2 ) ; BAO_Motion2 ( 0 , 0 ,  0,0);  %  bring  source 
all  the  way  up 
pause  ( 2 ) 
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^-k-k-k  Initialization 


%  5V  =  5sec 

voltage  =  10  %  motor  voltage  for  test 
t  =  3.0  %  period  of  test  in  seconds 

t  =  t/0.01  %  segment  test  period  time  segments  to  be  used  in  arrays. 

See  for  loop  below 

Time  =  zeros (l,t);  %  time  array 

read  =  zeros (l,t);  %  encoder  reading  array 

encoders  =  BAO_Motion2 ( 0 , 0 ,  0,0);  %take  initial  reading 
read(l)  =  encoders (4);  %  read  encoder  count 

Time(l)  =  0;  %  initial  time  is  zero 

Start  Test 

BAO_Motion2 ( 0 , voltage,  0,0);  tic  %start  motion  &  time 

for  i=l:t;  %  carry  out  readings  for  f^O.Ol  seconds;  period^pausc^i (max) 
encoders  =  BAO_Motion2 ( 0 , voltage,  0,0);  %  read  encoders 
Time(i+1)  =  toe;  %  read  time 

read(i+l)  =  encoders (4);  %  choose  elevation  encoder  reading 
pause (0.01) 

end 

BAO_Motion2 (0, 0,  0,0);  %  Stop  motion 


^-k-k-k-k  Calculations 

dX  =  zeros (l,t);  %  initialization 
dT  =  zeros (l,t);  %  initialization 

for  i=l:t  %  calculate  dX  &  dT 
dX(i)  =  read(i+l)  -  read(i); 
dT(i)  =  Time(i+1)  -  Time(i); 

end 

vel  =  dX./dT;  %  velocity  in  counts/s 

w  =  vel .  "^  ( 1/572 96)  ;  %  angular  velocity.  1  rad  =  57296  counts 
Plots 

%  First  need  to  calc  time  interval  midpoint  for  each  angular  vel 
for  i  =  1 : t 

w_time(i)  =  Time(i+1)  -  dT(i)/2; 

end 
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%  plot  time  vs  angular  vel  (rads/sec) 


figure 

plot (w_time, -w) 
xlabel('time  (sec)  ') 

ylabel (' Angular  Velocity  (rads/sec)') 

title ([’ Elevation  Down  Instantaneous  Angular  Velocity  (rads/s)  for 

Voltage  =  num2str (voltage) , '  V']) 

grid 

%  Plot  Transfer  function.  Must  run  Simulink  Model  elevation_down . mdl 
first  to  get  sim_time  & 

%  velocity 
hold 

plot ( sim_time, velocity,  'r') 

legend (’ Measured  Data Transfer  Function') 

o 

o 

%  %  plot  calculated  response  curve 

o 

o 

%  Km=0.0093 
%  a=10 
%  Tm=0.112 

%  Wt^Km'^a'^  ( 1-exp  ( -w_time/Tm)  ) 

%  hold 

%  plot (w_time, Wt ,  ' r '  ) 


%  plot  time  vs  angular  vel  (degrees/sec) 

%  figure 

%  plot (w_time, ( 180/pi) ) 

%  xlabel('time  (sec)') 

%  ylabel (' Angular  Velocity  (degrees/sec) ') 

%  title ([' Elevation  Down  Instantaneous  Angular  Velocity  (deg/s) for 
Voltage  =  ', num2str (voltage)  ,  '  V']) 

%  grid 

%  plot  time  vs  position  (rads) 

%  figure 

%  plot (Time, read. 757296) 

%  xlabel('time  (sec)') 

%  ylabel (' Position  (rads)') 

%  title ([' Elevation  Down  Position  (rads)  for  Voltage  = 

', num2str (voltage) , '  V']) 

%  grid 


%  plot  time  vs  position  (degrees) 
%  figure 

%  plot  (Time,  (read. /57296)  "^ISO/pi) 
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%  xlabel ( ' time  (sec)') 

%  ylabel (' Position  (degrees)') 

%  titie ( [ ' Eievation  Down  Position  (degrees)  for  Voitage  = 
' , numPstr (voitage) , '  V']) 

%  grid 

o  o 
o  o 


o 

-k  -k  -k  -k 

%%  Azimuth  Back  Measurements 

9'k^k^k^k^k^k^k^k^k^k^k^k^k^k^k^k^k^'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k 

o 

■k  -k  -k  -k 


%ciear  aii 
cic 

%-k'k-k  Prep  axis  for  test 

HomePosition; %  Send  the  Source  to  the  home  position, 
pause (i); 

BA0_Motion2 ( -5 , 0 ,  0 , 0 ) ; pause ( 5 . 0 ) ; BA0_Motion2 ( 0 , 0 ,  0,0);  %  bring  source 
aii  the  way  fwd 
pause  ( 2 ) 

%'k'k-k  initiaiization 

voitage  =  iO;  %  motor  voitage  for  test 
t  =  2.5;  %  period  of  test  in  seconds 

t  =  t/O.Oi;  %  segment  test  period  time  segments  to  be  used  in  arrays. 
See  for  ioop  beiow 

Time  =  zeros (i,t);  %  time  array 

read  =  zeros (i,t);  %  encoder  reading  array 

encoders  =  BAO_Motion2 ( 0 , 0 ,  0,0);  %take  initiai  reading 
read(i)  =  encoders (3) ;  %  read  encoder  count 

Time(i)  =  0;  %  initiai  time  is  zero 

Start  Test 

BAO_Motion2 (voitage, 0 ,  0,0);  tic  %start  motion  &  time 

for  i=i:t;  %  carry  out  readings  for  f^O.Oi  seconds;  period^pausc^i (max) 
encoders  =  BAO_Motion2 (voitage, 0 ,  0,0);  %  read  encoders 
Time(i+i)  =  toe;  %  read  time 

read(i+i)  =  encoders (3) ;  %  choose  azimuth  encoder  reading 
pause  ( 0 . Oi ) 

end 

BAO_Motion2 ( 0 , 0 ,  0,0);  %  Stop  motion 


%-k-k-k-k  Caicuiations 
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dX  =  zeros %  initialization 
dT  =  zeros (l,t);  %  initialization 

for  i=l:t  %  calculate  dX  &  dT 
dX(i)  =  read(i+l)  -  read(i); 
dT(i)  =  Time(i+1)  -  Time(i); 

end 

vel  =  dX./dT;  %  velocity  in  counts/s 

w  =  vel .  ( 1/572 96)  ;  %  angular  velocity.  1  rad  =  57296  counts 

Plots 

%  First  need  to  calc  time  interval  midpoint  for  each  angular  vel 
for  i  =  1 : t 

w_time(i)  =  Time (1+1)  -  dT(i)/2; 

end 

%  plot  time  vs  angular  vel  (rads/sec) 
figure 

plot (w_time, abs (w) ) 
xlabel('time  (sec)') 

ylabel (' Angular  Velocity  (rads/sec)') 

title ([' Azimuth  Back  Instantaneous  Angular  Velocity  (rads/s)  for 

Voltage  =  num2str (voltage)  ,  '  V']) 

grid 

%  Plot  Transfer  function.  Must  run  Simulink  Model  Azimuth_back, mdl 
first  to  get  sim_time  & 

%  velocity 

hold 

plot ( sim_time, velocity,  'r') 

legend (' Measured  Data Transfer  Function') 

%  plot  calculated  response  curve 

%  Km=  0 . 0155 
%  a=10 
%  Tm=0.048 

%  Wt^Km'^a'^  ( 1-exp  (-w_time/Tm)  ) 

%  hold 

%  plot (w_time, Wt ,  ' r '  ) 


%  plot  time  vs  angular  vel  (degrees/sec) 
%  figure 

%  plot (w_time, abs (w^ ( 180/pi) ) ) 

%  xlabel('time  (sec)') 
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for 


%  ylabel (' Angular  Velocity  (degrees/sec)  ') 

%  title ([' Azimuth  Back  Instantaneous  Angular  Velocity  (deg/s) 
Voltage  =  num2str (voltage)  ,  '  V']) 

%  grid 

%  plot  time  vs  position  (rads) 

%  figure 

%  plot (Time, read. 757296) 

%  xlabel('time  (sec)') 

%  ylabel (' Position  (rads)') 

%  title ([' Azimuth  Back  Position  (rads)  for  Voltage  = 

', num2str (voltage) , '  V']) 

%  grid 

%  plot  time  vs  position  (degrees) 

%  figure 

%  plot  (Time,  (read.  757296)  "^ISO/pi) 

%  xlabel('time  (sec)') 

%  ylabel (' Position  (degrees)') 

%  title ([' Azimuth  Back  Position  (degrees) for  Voltage  = 

', num2str (voltage) , '  V']) 

%  grid 


o 

kkkk 

%%  Azimuth  Fwd  Measurements 

o 

kkkk 


%clear  all 
clc 

%kkk  Prep  axis  for  test 

HomePosition; %  Send  the  Source  to  the  home  position, 
pause (1); 

BA0_Motion2 ( 5 , 0 ,  0 , 0 ) ; pause ( 6 . 0 ) ; BA0_Motion2 ( 0 , 0 ,  0,0);  %  bring  source 
all  the  way  fwd 
pause  (2 ) 

%kkk  Initialization 

voltage  =  10;  %  motor  voltage  for  test 
t  =  2.5;  %  period  of  test  in  seconds 

t  =  t70.01;  %  segment  test  period  time  segments  to  be  used  in  arrays. 

See  for  loop  below 

Time  =  zeros (l,t);  %  time  array 

read  =  zeros (l,t);  %  encoder  reading  array 
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encoders  =  BA0_Motion2 ( 0 , 0 ,  0,0);  %take  initial  reading 
read(l)  =  encoders (3) ;  %  read  encoder  count 

Time(l)  =  0;  %  initial  time  is  zero 

Start  Test 


BAO_Motion2 ( -voltage, 0 ,  0,0);  tic  %start  motion  &  time 

for  i=l:t;  %  carry  out  readings  for  8  seconds;  period^pausc^i (max) 
encoders  =  BAO_Motion2 ( -voltage, 0 ,  0,0);  %  read  encoders 
Time(i+1)  =  toe;  %  read  time 

read(i  +  l)  =  encoders (3)  ;  %  choose  elevation  encoder  reading 
pause (0.01) 

end 

BAO_Motion2 (0, 0,  0,0);  %  Stop  motion 


%~k~k~k~k  Calculations 

dX  =  zeros (l,t);  %  initialization 
dT  =  zeros (l,t);  %  initialization 

for  i=l:t  %  calculate  dX  &  dT 
dX(i)  =  read(i+l)  -  read(i); 
dT(i)  =  Time(i+1)  -  Time(i); 

end 

vel  =  dX./dT;  %  velocity  in  counts/s 

w  =  vel .  "^  ( 1/572 96)  ;  %  angular  velocity.  1  rad  =  57296  counts 
Plots 

%  First  need  to  calc  time  interval  midpoint  for  each  angular  vel 
for  i  =  1 : t 

w_time(i)  =  Time(i+1)  -  dT(i)/2; 

end 

%  plot  time  vs  angular  vel  (rads/sec) 
figure 

plot (w_time,w) 
xlabel('time  (sec)') 

ylabel (' Angular  Velocity  (rads/sec)') 

title ([' Azimuth  Fwd  Instantaneous  Angular  Velocity  (rads/s)  for  Voltage 

=  ', num2str (voltage) , '  V']) 

grid 
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%  Plot  Transfer  function.  Must  run  Simulink  Model  Azimuth_fwd . mdl 
first  to  get  sim_time  & 

%  velocity 

hold 

plot ( sim_time, velocity,  'r') 

legend (' Measured  Data Transfer  Function') 

%  plot  calculated  response  curve 

%  Km=0.0147 
%  a=10 
%  Tm=0.04 

%  Wt=Km'^a'^  ( 1-exp  (-w_time/Tm)  ) 

%  hold 

%  plot (w_time, Wt ,  ' r '  ) 


%  plot  time  vs  angular  vel  (degrees/sec) 

%  figure 

%  plot (w_time, ( 180/pi) ) 

%  xlabel('time  (sec)') 

%  ylabel (' Angular  Velocity  (degrees/sec) ') 

%  title ([' Azimuth  Fwd  Instantaneous  Angular  Velocity  (deg/s)  for 
Voltage  =  ', numPstr (voltage)  ,  '  V']) 

%  grid 

%  plot  time  vs  position  (rads) 

%  figure 

%  plot (Time, read. 757296) 

%  xlabel('time  (sec)') 

%  ylabel (' Position  (rads)') 

%  title ([' Azimuth  Fwd  Position  (rads)  for  Voltage  =  ', numPstr (voltage) , 
V']) 

%  grid 

%  plot  time  vs  position  (degrees) 

%  figure 

%  plot  (Time,  (read. /57296)  "^ISO/pi) 

%  xlabel('time  (sec)') 

%  ylabel (' Position  (degrees)') 

%  title ([' Azimuth  Fwd  Position  (degrees)  for  Voltage  = 

', num2str (voltage) , '  V']) 

%  grid 


o 

o 


HomePosition; 


end  of  Test 


APPENDIX  G:  MATLAB  CODE  FOR  FSM  EXPERIMENTAL 

TESTING 


o 

%  FSM_transfer_f unction . m  -  Drives  FSM  for  TF  testing 

o 

o 

%  LCDR  Scott  Johnson,  Jul  06 

o 

o  o 
o  o 

%  Calibration 
pause ( 5 ) 

BAO_Motion2 ( 0 , 0 ,  -0 . 50 , 0 )  ; pause (0 . 000001)  ;BAO_Motion2 (0,0,  0,0); 

o  o 
o  o 


%  Draw  a  circle 

BAO_Motion2 (1000000,0,  0,0) ; 
for  x=0 : 0 . 1 : 10 

BAO_Motion2 (0,0, sin (x) , cos (x) ) ; 

pause (0.1) 

end 

BAO_Motion2 (0,0,  0,0); 

BAO_Motion2 (-1000000,0,  0,0)  ; 

o  o 
o  o 

%  Chirp  test 

%  Y  =  chirp (t, fO , tl , fl )  generates  samples  of  a  linear  swept-f requency 
cosine  signal  at  the  time 

%  instances  defined  in  array  t,  where  fO  is  the  instantaneous  frequency 
at  time  0,  and  fl  is 

%  the  instantaneous  frequency  at  time  tl .  fO  and  fl  are  both  in  hertz. 

%  If  unspecified,  fO  is  0,  tl  is  1,  and  fl  is  100. 

o  o 
o  o 

clear  all 

BAO_Motion2 (1000000,0,  0,0)  ; 

END  =  100;  %33  =  34  sec 
count  =  0; 
end_freq  =  1000; 
interval  =  0.000037; 


t=0 : interval : END; 
y  =  chirp (t, 0 , END, end_freq); 


count  =  0; 

o  o 
o  o 


tic 

for  tl=0 : interval : END 
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count  =  count+1; 

V  =  0  .  (count )  ; 

BAO_Motion2 ( 0 , 0 , V, 0 ) ;  % (x, x, y-dir , x-dir ) 

end 

toe 

BA0_Motion2 (0,0,  0,0); 

BAO_Motion2 (-1000000,0,  0,0)  ; 
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APPENDIX  I:  MATLAB  CODE  FOR  MOTOR  AND  FAST 
STEERING  MIRROR  CONTROL 


o 

%TrackNPS_Beacons .m 

%  Created  by  Baker  Adaptive  Optics 

o 

o 

%  Modified  by:  Scott  Johnson 

o 

%  Note:  Sticktion  voltage  on  azimuth  axis  =  2.7  volts 
%  Sticktion  voltage  on  elevation  axis  =  3.6  volts 

%  Note:  TASS2  must  be  level  before  starting  the  test. 

o 

%  Initializations 

o 

-k  -k  -k  -k 

o  o 
o  o 

close  all; clear  all;clc 

%  Start  initializing  the  platform 

monograb (2);  %  deinitialize  frame-grabber  camera 

clear  -mex; 


Set_Iterations  =  1200; 
sequence  will  run. 

iteration  =  0; 


%  Set  the  number  of  iterations  the  tracking 
%  Approx  30  secs  per  1000  interations . 


dX_previous  =  0; 

HomePosition;  %  Send  the  Source  to  the  home  position.  This  also 
initializes  the  mount  controller, 
pause ( 1 ) ; 

%  end  track 

BAO_Motion2 ( 0 , 5 ,  0 , 0 ) ; pause  ( 3 . 8 ) ; BAO_Motion2 ( 0 , 0 ,  0,0);  %pre-set  the 
elevation  to  look  near  the  3  spots 

BAO_Motion2 ( -5 , 0 ,  0 , 0 ); pause ( 0 . 25 ); BAO_Motion2 ( 0 , 0 ,  0,0);  %pre-set  the 
azimuth  to  look  near  the  3  spots 
%  middle  track 

%  BAO_Motion2 (0, 5,  0 , 0 ) ; pause ( 3 . 1 ) ; BAO_Motion2 ( 0 , 0 ,  0,0); 

%  BAO_Motion2 ( 5 , 0 ,  0 , 0 ) ; pause ( 1 . 5 ) ; BAO_Motion2 ( 0 , 0 ,  0,0); 

%  %  Jeffs  Platform 

%  BAO_Motion2 (0, 5,  0 , 0 )  ; pause  ( 4 . 7 )  ; BAO_Motion2 ( 0 , 0 ,  0,0); 

%  BAO_Motion2 (-5, 0,  0 , 0 ) ; pause ( 1 . 5 ) ; BAO_Motion2 ( 0 , 0 ,  0,0); 


pause ( 2 ) ; 
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monograb (0) ; monograb (1) ; 


Initialize  frame-grabber 


o 

o 


BW=monograb (1)  ; 

image (BW ' ) ; colormap  Gray (255) ; axis 

image; set (go ' backings tore ' ,  ' of f ' ,  ' doublebuffer ' ,  ' on ' ) ; pause  ( 1 ) ; 
Pixel_Test  %  Call  this  program  to  get  telescope  offsets  in  pixels 

o  o 
o  o 

o 

%Calcs  for  FSM  Input  Shaping 

o 

wx  =  S'^pi'^SlS; 

Td_x  =  4.8e-3; 
zeta_x  =  0.11; 

Kx  =  exp ( ( -zeta_x) /sqrt ( l-zeta_x^2 ) ) ; 

Ax_l  =  1/ (1+Kx) ; 

Ax_2  =  Kx/(1+Kx); 

wy  =  2  "^p  1^^2  51; 

Td_y  =  3.9e-3; 
zeta_y  =  0.11; 

Ky  =  exp ( ( -zeta_y) /sqrt ( l-zeta_y^2 ) ) ; 

Ay_l  =  1/ (1+Kx) ; 

Ay_2  =  Kx/(1+Kx); 


o  o 
o  o 

to  =  clock;  %  initialization  to  calculate  running  time.  See  cmd 
»etime  at  end  of  program 
tic; told=0 ; 

o 

-k  -k  -k 

%  Begin  Iteration  Loop 

o 

■k-k-k-k 

9--k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k 

o 

%  Locate  and  mark  beacons 

9--k-k-k-k-kk-k-k-k-k-k-k-k-k-k-kk-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k 

o 

for  i=l : Set_Iterations ;  %set  how  many  iterations  the  tracking 
sequence  will  run 

iteration  =  iteration+1; 

BW=monograb ( 1 ) ; %First ,  Grab  an  image 

Xc (1) =0;Xc (2) =0;Xc (3) =0; Yc (1) =0; Yc (2) =0; Yc (3) =0; %then,  zero  out  the 
3  spot  x,y  coordinates 

%Now,  your  task  is  to  locate  the  3  beacon  spots. 

for  m=l:3;  %perform  the  search  3  times,  so  that  you  can  find 

them  all 

%"Cheap"  Centroiding  finds  the  first  brightest  spot 
[Vbw, Ybw] =max (max (BW) ) ; 

[Vbw, Xbw] =max (BW ( : , Ybw) ) ; 

s=15 ;  %boxsize=s'^2  +  l ,  s=kind  of  box  radius 
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if  (Xbw<s+1) I (Xbw>64 0-s-l ) | (Ybw<s+1) | (Ybw>480-s-l ) ;  %if  a 
spot  is  too  close  to  the  edge, 

Vbw=0;  %then 

set  it's  brightness  to  zero 
end; 


%" Inexpensive"  Centroiding  starts  with  "Cheap"  Result 

if  Vbw  >50  %if  the  spot 

was  brightest  spot  was  bright  enough 


Box=double (  BW (Xbw-s : Xbw+s , Ybw-s : Ybw+s )  ); 

box  with  the  spot  in  it 

for  j=l:2^s+l 

box 

for  k=l:2'^s  +  l 

box 

if  Box ( j , k) <25 

data  at  25  counts 

Box ( j , k) =0 ; 

else 


%BW (Xbw-s+ j -1 , Ybw-s+k-1 ) =0 ; 
>25  ct  spots  in  the  original  image 

end; 

some  parts  of  the  spots  in  the  image  graphics) 

BW (Xbw-s+ j -1 , Ybw-s+k-1 ) =0 ; 
entire  box  in  the  original  image 
end; 


end; 

[X, Y] =meshgrid (Xbw-s : Xbw+s , Ybw-s : Ybw+s ) ; 
pixels  in  original  image  space  for  the  box 
Sum=sum ( sum (Box) ) ; 

sum  of  the  box  for  the  centroid  calc. 

Xc  (m)  =sum  (sum  (X.  "^Box  '  )  )  /  (Sum+  .0000001)  ; 
centroid  of  this  iteration 

Yc  (m)  =sum  (sum  (Y  .  "^Box  '  )  )  /  (Sum+  .0000001)  ; 
centroid  of  this  iteration 
end; 


end; 

the  next  bright  spot 


%Then  grab  the 
%loop  over  the 
%loop  over  the 
%threshold  the 

%black-out  the 
% (you  can  see 
%black-out  the 

%define  the 
%compute  the 
%compute  the  X 
%compute  the  Y 

%now  go  on  to 


%At  this  stage,  you  have  located  three  centroids  of  the  three 
brightest 

%spots  in  the  image  BW. 


d(l)=sqrt(  (Xc  (2) -Xc  (1)  )  ^"2  +  ( Yc  ( 2  ) -Yc  ( 1 )  )  ^"2 
distance  between  spots  1  and  2 

d(2)=sqrt(  (Xc  ( 2  ) -Xc  ( 3 )  )  ^"2  +  ( Yc  ( 2  ) -Yc  ( 3 )  )  ^"2 
distance  between  spots  2  and  3 

d(3)=sqrt(  (Xc  ( 1 ) -Xc  ( 3 )  )  "2  +  ( Yc  ( 1 ) -Yc  ( 3 )  )  ^"2 
distance  between  spots  1  and  3 


);%compute  the 
);%compute  the 
);%compute  the 


%Next  we  determine  which  of  the  points  1,2,  and  3  are  A,B,  and  C 


[ longest , ilongest] =max (d) ;  %B-C 
[shortest, ishortest] =min (d) ;  %A-B 
if  (  ( ilongest==2 ) & ( ishortest==l )  ) 
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) 


A=1;B=2;C=3; 

elseif  (  ( ilongest==3 ) & ( ishortest==l ) 

A=2;B=1;C=3; 
elseif (  ( ilongest==l ) & ( ishortest==2 )  ) 

A=3;B=2;C=1; 

elseif  (  ( ilongest==3 ) & ( ishortest==2 )  ) 

A=2;B=3;C=1; 

elseif  (  ( ilongest==2 ) & ( ishortest==3 )  ) 

A=1;B=3;C=2; 

elseif  (  ( ilongest==l ) & ( ishortest==3 )  ) 

A=3;B=1;C=2; 

end; 


%Now  we  know  which  spots  are  which: 

%  (  Xc(A),Yc(A)  )  are  the  coords  of  spot  A 

%  (  Xc(B),Yc(B)  )  are  the  coords  of  spot  B 

%  (  Xc(C),Yc(C)  )  are  the  coords  of  spot  C 

%  Account  for  rotation  of  Beacons 


TASS_Rotation  =  asind ( ( Yc (B) -Yc (A) ) /Hyp_Tele) ; 


%  degrees 


Xa_R  =  Xc (B) + (Xc (A) -Xc (B) ) ^cosd(TASS_Rotation) ; 

Ya_R  =  Yc (A) - (Xc (A) -Xc (B) ) ^cosd (TASS_Rotation) ^tand (TASS_Rotation) ; 
X_Tele_R  =  Xa_R+Hyp_Tele'^cosd  (TASS_Rotation+Ang_Tele)  ; 

Y_Tele_R  =  Ya_R-Hyp_Tele'^sind  (TASS_Rotation+Ang_Tele)  ; 


Xsrc=430; Ysrc=180; 
display . 


%  This  is  the  location  of  the  source. 

%  Measured  in  pixels  from  the  top  left  of  camera 

%  Need  to  fine  tune  this  parameter  by  statically 
%  running  source  motors.  On  target  =  430,170 


%check  to  see  if  the  distance  around  the  spots  is  reasonable  to  see 
if 

%all  3  are  measured  properly  and  realistic.  The  sum  should  be 
around 

%125.  if  the  spots  are  not  likely  to  be  real,  call  the  error  zero 

and 

%stop  moving  until  they  come  back. 

%  if  (sum(d)>150) | ( sum (d) <100 ) ;  Xtele=Xof f ; Ytele=Yof f ;  end 
%  if  iteration==Set_iterations 

%  imagesc (BW ) ; axis  image;hold  on; text (Xc (A) , Yc (A) , ' A ' , ' Color ' , ' w ' ) 

o 

o 

text (Xc (B) , Yc (B) ,  ' B ' ,  'Color ' ,  ' w ' )  ; 

o 

o 

text  (Xc  (C)  ,  Yc  (C)  ,  'C  ,  'Color'  ,  'w'  )  ; 

o 

o 

text (X_Tele_R, Y_Tele_R,  ' T ' ,  ' Color '  ,  ' b ' ) ; 

%  text (Xsrc, Ysrc, 'S',' Color ' , ' r ' ) ; 

%  hold  off;drawnow; 

%  end 
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o\o  o\o  o\o  o\o  o\o  o\o 


compute  the  error  in  X  (azimuth) 
compute  the  error  in  Y  (elevation) 


dX=Xsrc-X_Tele_R; 
dY=Ysrc-Y_Tele_R; 

Control  Actions 

kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkk 

Motor  Controls 

kkkkkkkkkkkkkkkkkkkkkkkkkkkkk 


^kkkkkkkkkkkkkkkk  P  Gain 


Vaz=dX/ (-13) ;  %minus 
intended  direction 

sign 

account 

for 

directional 

difference 

dX 

Vel=dY/ (-25) ;  %minus 
intended  direction 

sign 

account 

for 

directional 

difference 

dX 

and 

and 


^  Integral  Calcs 

%  start  on  20th  interation 

if  i>50 

Area  =  dX+dX_previous ; 
dX_previous  =  Area; 

Vaz=Vaz  +  0  .  OOOOOOl'^abs  (Area)  ; 

end 

Correct  Voltages  for  Dynamic  Friction 

kkkkkkkkkkkk 

%  if  Vaz<0 ; Vaz=Vaz-l . 7 ; end; if  Vaz>0 ; Vaz=Vaz+l . 9 ; end; 

if  Vaz<0 ; Vaz=Vaz-2 ; end; if  Vaz>0 ; Vaz=Vaz+2 ; end; 
if  Vel<0;Vel= (Vel-4) ;end; if  Vel>0 ; Vel= (Vel+4 ) ; end; 

3qP  limits  on  Voltages  +-  lOV 

kkkkkkkkkkkkkkkkkkkkkkk 

if  Vaz>10 . ; Vaz=10 ; end; if  Vaz<-10 ; Vaz=-10 ; end; %def ine  upper  and 
lower  limits  for  drive  voltage  azimuth 

if  Vel>10 . ; Vel=10 ; end; if  Vel<-10 ; Vel=-10 ; end; %def ine  upper  and 
lower  limits  for  drive  voltage  elevation 

^kkkkkkkkkkkkkkkkkk  Initial  Voltage 

kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk 

%Set  initial  voltage  to  3  volts  on  first  iteration  to  overcome 
static 

%friction  (sticktion) 
if  iteration==l 

if  Vaz<0 ; Vaz=-3 ; end; if  Vaz>0 ; Vaz=3 ; end; 
if  Vel<0;Vel=-4;end; if  Vel>0 ; Vel=4 ; end; 
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o\o  o\o  o\o 


end 


Deadzone 

%  Create  a  Deadzone  for  motors  to  stop  working 

if  abs  (dX)  <  ( 0 . 9'^15'^X_Pix_ratio)  ;  %  [max  mirror  movement  (15mm)] 

X_Pix_ratio  (pixels/mm)  =  max  FSM  movement  (pixels) 

Vaz=0; 

dX_previous  =  0; 

end 

if  abs(dY)<  ( 0 . 9'^15'^Y_Pix_ratio)  ;  %  [max  mirror  movement  (15mm)] 

Y_Pix_ratio  (pixels/mm)  =  max  FSM  movement  (pixels) 

~Vel=0; 

end 

o  o 
o  o 

i^i^i^i^i^i^i^i^i^i^i^i^i^i^i^-^-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k 

Fast  Steering  Mirror  Commands . 

kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk 


%  Conversions 

%  Convert  dx  and  dy  into  voltages .  Tests  showed  that  when  the 
%  mirror  is  given  0.6V  the  movement  is  approx  15mm  at  TASS2 

Vx  =  (dX/X_Pix_ratio)  "^  ( 0 . 6/15 )  ; 

%  (dX  (pix)  /X_pix_ratio  (pix/mm)  )  "^  ( 0 . 6V/15mm)  =Volts 
Vy  =  (dY/Y_Pix_ratio) ^ ( 0 . 6/15 ) ; 

%  (dY  (pix)  /Y_pix_ratio  (pix/mm)  )  "^  ( 0 . 6V/15mm)  =Volts 


^kkkkkkkkkkkkkkkk  30^  Maximum  Voltages 
%  set  maximum  FSM  voltage  at  0.6  volts 

%  voltages  greater  than  0 . 6V  drives  the  laser  out  of  the  optics 

range 


if 

Vx 

> 

0.6;  Vx  =  0 

.  6 ; end 

if 

Vx 

< 

-0.6;  Vx  = 

-0.6; end 

if 

Vy 

> 

0.6;  Vy  =  0 

.  6 ;  end 

if 

Vy 

< 

-0.6;  Vy  = 

-0.6;  end 

Mx= 

=Vx^ 

15/0. 6*X  Pix 

ratio;  % 

(pixels ) 


mirror  movement  in  x-direction 


%  Vx  (volts )  (15mm/ 0 . 6volts )  (pix/mm) 

My=Vy'^15/0 . 6'^Y_Pix_ratio;  %  mirror  movement  in  y-direction 
(pixels ) 


Xmirror  =  Xsrc-Mx; 

Ymirror  =  Ysrc-My; 

Virtual_dX  =  Xmirror  -  X_Tele_R;  %  Difference  btw  Telescope  and 
laser  w/mirror  movement 

Virtual  dY  =  Ymirror  -  Y  Tele  R; 
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%********Change  polarity  on  voltages  to  match  mirror  directions*** 


%  Note:  this  matrix  takes  into  account  the  mirror  voltage 
directions 

%  as  well  as  the  error  directions  fm  the  image. 

V  =  [1  0;0  -l]*[Vy;Vx];  %  Scott 

%V  =  [0  -1;-1  0]*[Vx;Vy];  %  Jae 

Vxx  =  V ( 1 ) ; 

Vyy  =  V(2)  ; 


o  o 
o  o 


^-k-k-k-k-k-k-k-k-k-k-k  Movement  Commands  w/ Input 


BAO_Motion2 (Vaz , Vel, Ax_l^Vxx, Ay_l^Vyy) ; 
pause (Td_y/ 2 ) 

BAO_Motion2 (Vaz , Vel, Ax_l^Vxx, Vyy) ; 
pause (Td_x/2-Td_y/2 ) 

BAO_Motion2 (Vaz , Vel , Vxx, Vyy) ; 

%  BAO_Motion2 (Vaz, Vel, 0, 0) ; 

%  BAO_Motion2 ( 0 , 0 , Ax_l^Vxx, Ay_l^Vyy) ; 

%  pause (Td_y/wy) 

%  BAO_Motion2  (0, 0 ,  Ax_l'^Vxx,  Vyy)  ; 

%  pause (Td_x/wx-Td_y/wy) 

%  BAO_Motion2 ( 0 , 0 , Vxx, Vyy) ; 


tnew=toc; 
dt  =  tnew-told; 
freq=l/ (dt) ; 
told=toc; 


Create  arrays  for  plots 

'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k'k 


X_error ( iteration) =  dX; 
Y_error ( iteration) =  dY; 
V_azimuth ( iteration)  =  Vaz; 
V_elevation ( iteration)  =  Vel; 
V_x ( iteration)  =  Vxx; 

V_y ( iteration)  =  Vyy; 
frequency ( iteration) =  freq; 
Time ( iteration)  =  toe; 

%AREA ( iteration) =Area; 

Dl_2 (iteration)  =  d(l); 

D2_3 ( iteration)  =  d(2); 

D3_l (iteration)  =  d(3); 

XA ( iteration)  =  Xc (A) ; 

YA ( iteration) =  Yc (A) ; 

XB ( iteration)  =  Xc (B) ; 

YB  ( iteration) =  Yc (B)  ; 
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Virtual_x ( iteration)  =  Virtual_dX; 

Virtual_y ( iteration)  =  Virtual_dY; 

M_x ( iteration)  =  Mx; 

X_mirror ( iteration)  =  Xmirror; 

M_y ( iteration)  =  My; 

end;  %  end  of  iteration  loop 

total_time  =  etime(clock,to); 

BA0_Motion2 ( 0 , 0 ,  0,0);%stop  the  motors  when  you're  done! 
monograb (2);  %  de-initialize  the  camera 

o 

%  Post  Operation  Procedures 

o 


^-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k-k  Display  Performance  Stats  in  workspace 
results^ [X_error ; Y_error ; V_x; V_y] ; 

results  =  [Xc(A)  Yc(A);Xc(B)  Yc (B) ;  Yc (A) -Yc (B)  0] 

%  plot (Time, V_x, Time, V_y, '--' ) 

%  legend (' Vx Vy ' ) 

o 

o 

%  figure 

%  plot (Time, V_azimuth, Time, V_elevation, ' -- ' ) 

%  legend (' Vaz Vele ' ) 

%  total_time 

avg_freq  =  mean ( frequency) 

o 

%  Create  Error  Plots 

o 

o  o 
o  o 

%  Plot  X_error  &  Azimuth  Voltage 

[AX, Hl,H2]=  plotyy (Time, X_error , Time, V_azimuth) 
title ('X  Error  Plot') 
xlabel('Time  (sec)') 
ylabel('X  Error  (pixels) ') 

set (get (AX ( 2 ) , ' Ylabel ' ) , ' String ' , ' Azimuth  Voltage  (V) ' ) 

set(H2, 'LineStyle', '--') 

grid 

axis 

figure 
hold  on 

plot (Time, V_azimuth) 
plot (Time, X_error, ' r ' ) 
axis ( [0  30  -15  5] ) 
title ('X  Error  Plot') 
plot (Time, Virtual_x, 'g') 
grid 

legend('Az  Volts ',' X_error ',' Virtual  Error') 
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Plot  Y_error  &  Elevation  Voltage 


o 

o 


figure 

[AX, Hl,H2]=  plotyy (Time, Y_error , Time, V_e leva t ion) 
title ('Y  Error  Plot') 
xlabel('Time  (sec)') 
ylabel('Y  Error  (pixels) ') 

set (get (AX (2 ),' Ylabel '),' String ',' Elevation  Voltage  (V) ' ) 

set(H2, 'LineStyle', '--') 

grid 

axis 

%  figure 

%  plot (Time, AREA) 

%  grid 

%close  all 
Test_plots 
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